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ABSTRACT 


(S’ 


— Six  algorithms  for  finding  the  range  to  an  airborne 
target  using  noise-corrupted  bearing  and  bearing  rate  measure- 
ments  from  an  airborne  sensor  were  developed  and  evaluated. 

The  algorithms  all  employ  extended  Kalman  filters,  one  using 
a  spherical  coordinate  system  representation,  and  the  other 
five  using  Cartesian  system  representation.  The  target  models 
include  independent,  Gauss-Markov  acceleration  (two  algorithms), 
constant  turn  rate  motion  in  a  single  plane  (one  algorithm), 
and  basically  straight  and  level  flight  (three  algorithms). 

The  algorithms  were  evaluated  in  a  Monte  Carlo  analysis. 

The  truth  model  for  this  analysis  was  based  upon  two  trajectories, 
one  for  the  target  and  one  for  the  attacker,  which  were  deter¬ 
ministically  set  before  the  Monte  Carlo  runs.  The  output  of 
the  simulation  was  composed  of  plots  of  the  error  process,  in¬ 
cluding  the  mean  of  the  errors,  the  mean  of  the  errors  plus 
and  minus  one  standard  deviation,  and  the  positive  and  negative 
filter-generated  estimate  of  the  standard  deviation  of  the 
errors . 

v 

It  was  found  that,  due  to  an  observability  problem,  only 
the  algorithms  which  modelled  target  motion  as  straight  and 
level  flight  worked  satisfactorily.  These  algorithms  worked 
best  in  scenarios  in  which  the  actual  target  motion  was  nearly 
directly  toward  or  directly  away  from  the  attacking  aircraft.  . 
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ANALYSIS  OF  SIX  ALGORITHMS  FOR  BEARING-ONLY 


RANGING  IN  AN  AIR-TO-AIR  ENVIRONMENT 
CHAPTER  I 
INTRODUCTION 


1.1  Background 

The  problem  of  determining  the  distance  to  a  target  when 
given  only  noise-corrupted  bearing  information  has  received 
increased  attention  in  recent  years  (1;  2;  3;  4;  11).  Through¬ 
out  the  1970's,  research  has  been  conducted  in  this  area  by 
several  Individuals  and  organizations,  most  notably  the  U.S. 
Naval  Underwater  Systems  Center  in  Newport,  Rhode  Island. 

Because  the  applications  of  bearing-only  ranging  have  been 
limited  chiefly  to  naval  scenarios  in  which  bearing  measure¬ 
ments  are  obtained  from  acoustic  sensors,  however,  the  dyna¬ 
mics  of  the  problem  have  been  modelled  as  occurring  slowly 
and  in  a  single  plane  of  motion. 

Presently,  the  Air  Force  relies  almost  exclusively  on 
radar  for  target  acquisition  and  tracking.  Because  radar  must 
actively  transmit  an  RF  signal  in  order  to  obtain  target  in¬ 
formation,  however,  it  is  a  relatively  simple  matter  for  the 
target  to  detect  that  he  is  being  illuminated  by  a  radar 
transmitter.  The  current  trend  toward  "stealth"  technology 
points  toward  the  development  of  a  sensor  which  could  detect 
and  track  the  line  of  sight  to  a  target,  providing  accurate 
bearing  and  bearing  rate  measurements  to  the  tracking  algorithm 
In  order  for  this  sensor  to  work  effectively,  however,  it 


would  be  necessary  for  the  algorithm  to  compute  the  target's 
range  from  these  angle  and  angle  rate  measurements  *  Thus  one 
may  see  a  future  requirement  for  a  bearing-only  ranging  al¬ 
gorithm  which  functions  in  the  dynamic ,  three-dimensional 
environment  of  air-to-air  combat. 

1.2  Problem  Statement  and  Objectives 

This  thesis  presents  the  development  and  evaluation  of 
six  proposed  algorithms  for  finding  range  to  a  target,  given 
noise  corrupted  azimuth,  elevation,  azimuth  rate,  and  elevation 
rate  from  a  simulated  sensor.  The  six  algorithms  proposed  for 
this  study  all  use  the  extended  Kalman  filter  (6:44-59)  to 
estimate  range  recursively.  The  evaluation  of  these  algorithms 
is  done  by  means  of  Monte  Carlo  simulations  (5:325-329;  9) 
which  provide  a  means  of  measuring  algorithm  performance  under 
the  conditions  of  specific  combinations  of  sensor  noises  and 
engagement  scenarios.  Obviously,  the  six  ranging  methods  can¬ 
not  be  evaluated  under  every  possible  combination  of  target 
and  own-ship  maneuver;  therefore,  only  the  most  promising  al¬ 
gorithms  (based  on  tracking  performance  in  one  engagement 
scenario)  are  tested  extensively  for  the  following  target 
traj  ectorles : 

1)  benign  target  maneuvers  which  meet  the  target 
modelling  assumption  of  the  algorithm, 

2)  target  maneuvers  which  are  representative  of  real 
world  situations, 

3)  target  maneuvers  which  are  expected  to  cause  the 
greatest  errors  in  the  algorithm's  rang£  estimate. 


In  comparing  the  performance  of  the  different  algorithms,  two 
main  characteristics  will  be  examined; 


1)  the  time  the  algorithm  takes  to  converge  from 

erroneous  initial  conditions,  * 

2)  the  tracking  error  after  convergence, 

1.3  Organization 

This  thesis  is  organized  so  that  the  reader  can  follow 
the  development  and  testing  in  the  chronological  order  in 
which  they  would  logically  occur.  Chapter  1  contains  the 
background  information  and  states  the  problem  and  objectives 
of  this  study.  Chapter  2  gives  the  reader  unfamiliar  with 
Kalman  filtering  techniques  a  short  summary  of  the  equations 
and  assumptions  involved.  In  Chapter  3  the  development  of  the 
six  algorithms  to  be  tested  is  presented.  Chapter  4  discusses 
the  truth  model  and  the  method  of  evaluation.  Chapter  5  con¬ 
tains  the  results  of  the  study,  and  Chapter  6  contains  the 
conclusions  and  recommendations. 


CHAPTER  II 


THE  KALMAN  FILTER 


2.1  Introduction 

Because  the  ranging  algorithms  examined  in  this  thesis 
are  dependent  upon  some  form  of  Kalman  filter  for  range  esti¬ 
mation,  it  is  necessary  that  the  reader  be  familiar,  if  not 
with  the  derivation,  at  least  with  the  equations  and  basic 
assumptions  associated  with  Kalman  filters.  This  chapter 
presents  a  summary  of  the  modelling  assumptions  and  equations 
for  both  the  basic  Kalman  filter,  used  with  linear  systems, 
and  the  extended  Kalman  filter  (EKF) ,  used  with  systems  which 
have  nonlinear  dynamics  or  measurement  equations. 

Those  readers  familiar  with  Kalman  filtering  techniques 
may  skip  this  chapter  without  loss  of  continuity.  Those  re¬ 
quiring  a  more  in-depth  description  of  stochastic  processes 

4>. 

and  the  derivation  of  the  Kalman  filter  are  referred  to 
References  5  and  6. 

2.2  System  Modelling 

The  Kalman  filter  is  designed  to  provide  an  estimate  of 
the  states  of  a  system  which  can  be  modelled  as  n  coupled 
first-order  stochastic  differential  equations  driven  by 
white  Gaussian  noise,  where  the  filter  is  provided  with  m 
measurement s  which  are  functions  of  the  system  states  cor¬ 
rupted  by  zero-mean,  white,  Gaussian  noise.  A  Kalman  filter 
formulation  to  process  continuous  time  measurements  is  pos¬ 
sible;  however,  since  all  algorithms  examined  in  this  thesis 


use  sampled-data  measurements  appropriate  for  filter  imple¬ 
mentation  in  a  digital  computer,  only  the  discrete-time  formu 
lation  will  be  discussed  here. 


If  the  system  dynamics  and  measurement  equations  are 
linear,  they  may  be  written 

x(t)  =  F(t)x(t)  +  B(t)u(t)  +  G(t)w(t) 

Z(ti)  =  H(ti)x(ti)  +  v ( t 1 ) 

where 

x ( t )  =  system  state  vector  at  time  t  (dimension  n) 

F  ( t )  =  dynamics  matrix  at  time  t  (dimension  nxn) 

3(t)  =  control  input  matrix  at  time  t  (dimension  nxc) 
u(t)  =  control  input  vector  to  the  system  at  time  t 
(dimension  c) 

0 ( t )  =  noise  input  matrix  at  time  t  (dimension  nxs) 
w(t)  =  input  white,  Gaussian  noise  vector  (dimension 
with  statistics  E[w(t)]  =  o 


(1) 

(?) 


s ) 


1^'i) 

H(t.) 


E[w( t ) w1 ( t  +  T  )  ]  =  Q(t)  6 ( t  ) 
measurement  vector  at  time  t ^  (dimension  m) 
measurement  matrix  at  time  t^  (dimension  iiixi.) 
discrete-time,  while,  Gaussian  noise  vector 
(dimension  m)  with  statistics  E[v(t  )]  =  o 

E [v( t .  )y '(’...)  ]  = 


In  the  more  general  case,  where  the  dynamics  and  measure¬ 
ment  equations  are  not  constrained  to  be  linear,  the  dynamics 
and  measurement  equations  become 

x(t)  =  f[x(t),  u(t),  t]  +  G(t)w(t)  .  (3) 

Z(t =  hCxCt^^),  ti]  +  vCtj^)  <  (4) 

where 

f[x(t),  u(t) ,  t]  =  dynamics  equation  vector  which  relates 
x(t)  and  x(t)  at  time  t  (dimension  n) 

h[x(t.),  t^]  =  measurement  equation  vector  at  time  t^ 
(dimension  m) 

In  both  the  linear  and  nonlinear  case,  the  initial  con¬ 
ditions  are  given  by  the  random  Gaussian  vector  x(*tQ).  Addi¬ 
tionally,  the  dynamics  driving  noise  w(t)  and  the  measurement 
corruption  noise  v(t)  are  always  added  linearly,  and  w(t), 

v(t),  and  x(t  )  are  assumed  uncorrelated.  These  assumptions 
—  —  o 

are  inherent  in  the  derivation  of  the  basic  and  extended  Kalman 
filter,  and  will  be  adhered  to  throughout  this  thesis. 

2.3  The  Basic  Kalman  Filter 

The  basic  Kalman  filter  assumes  a  system  with  lin-'-ar 
dynamics  and  measurements,  given  by  Equations  (1)  and  12). 
Equation  (1)  expresses  the  continuous  time  relationship 
between  x(t)  and  x(t);  this  equation  can  be  discretized  by 
using  the  state  transition  matrix  associated  with  F(t)  to  give 


(5) 


i 

X(t1)=$(ti,ti_i)x(t1^i)+  f  ♦(t1,T)[B(T)uCt)+G(.T)w(T)]d 

^  J  -t 


where  t ^ , t ^  =  state  transition  matrix  from  time  t1  ^  to 

time  ti  (dimension  nxn) 

If  we  further  assume  that  the  control  vector  u(t)  is  held 
constant  over  the  sample  period,  equation  (5)  becomes 

=  *(ti,t1_i)x(t1<_1)  +  B<J(t1_1)u(t1_1)  + 


^(t^,  T  )  G  (  T  )  w(  T  )dx 


where 


-d^i-l^  - 


-L 

$(t1,T)B(T)dT 


The  basic  Kalman  filter  propagation  equations  are 
approximated  by 


x(t1  )  -  (ti_q  )  + 


p<tr>  - 


+  H ti , T )G( T )Q( T )G* ( T )^T( t1 , T )dT 


where 


PC  t±) 


=  the  filter-generated  state  estimate  error  co- 
variance  matrix  at  time  t1  (dimension  nxn) 
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3. 

I 

I 

: 

»* 

i 


The  “  and  +  superscripts  on  the  time  arguments  in  Equa¬ 
tions  (7)  and  (8)  and  all  subsequent  equations  indicate  before 
and  after  the  measurement  is  incorporated,  respectively. 

P(ti~),  for  example,  represents  the  error  covariance  matrix 
at  time  t^  before  the  measurement  has  been  incorporated. 

The  exact  form  for  the  propagation  equations  (no  longer 
assuming  a  constant  u(t)  over  the  sample  period)Ais  % 

xCt/t^i)  =  PCt)xCt/t±wl)  +  B(t)uCt)  (9) 

P(t/ti_l)  =  P(t)P(t/t1_1)  +  P(t/t1_1)FT(t)  +  G(t)Q(t)GT(t) 

(10) 


i  w 

r. 

5 

i 

4 

\ 

4 


to  be  integrated  from  t1  ^ -to  t^  using  the  Initial  conditions 
-(ti-l/tl-l)  =  -^i-l  ^ 

P(t1_i/t1_i)  =  P(ti_1  ) 

The  filter  update  equations  at  the  next  measurement  sample 
time  t  are 

K(tj_)  =  P(ti')HTCti)[H(t1)P(ti_)HT(ti)  +  R(ti)]"1  (11) 

x(t1+)  =  x(t^)  +  K(ti)[Z(t1)  -  H(t1)x(ti~)]  (12) 

P(tj_+)  =  P(t1")  -  K(t1)H(ti)P(ti“)  (13) 


1 


8 


where 


K(t^)  =  filter  gain  matrix  at  time  t^  (dimension  nxm) 

It  can  be  shown  that  the  solution  to  the  linear  stochastic 
differential  equation  of  Equation  (6)  is  a  Gauss-Markov  process, 
and  that  x(t)  for  any  fixed  time  t  is  a  Gaussian  random  vari¬ 
able  (5:164-168).  It  can  be  further  shown  that  the  estimate 
generated  by  the  Kalman  filter  is,  in  the  case  of  linear 
dynamics  and  measurement  equations,  the  optimum  estimate  in 
the  following  respects; 

1)  xCt^+)  •i-s  wean,  mode,  and  median  of  the  proba¬ 
bility  density  function  of  the  state  vector,  condi¬ 
tioned  on  the  entire  measurement  history  (5:206-226), 

2)  x(t^T)  is  the  minimum  mean  square  error  estimate  (5:232) 
*  + 

3)  )  Is  the  maximum  a  posteriori  estimate  (5:234). 

2.4  The  Extended  Kalman  Filter  (26:42-59) 

The  extended  Kalman  filter  is  an  extension  of  the  Kalman 
filter  (as  the  name  might  imply)  to  the  case  where  either 
f [x(t ) , u( t ) , t ]  in  Equation  (3),  or  h[x(ti),ti]  in  Equation  (4), 
or  both,  are  nonlinear  functions.  The  EKP  repeatedly  re¬ 
linearizes  the  dynamics  and  measurement  equations  by  assuming 
that  perturbations  of  the  state  vector  x(t)  from  a  repeatedly 
redefined  nominal  are  small  over  the  sample  period.  Thus, 
while  the  linear  Kalman  filter  guarantees  an  optimal  estimate, 
the  EKF  estimate  is  "optimal"  only  to  the  extent  that  the 
small  perturbation  assumption  is  true. 


The  propagation  equations  for  the  EKP  are 


£(fc/ti-l)  =  u(t),  t]  (1^1) 

P(t/ti_1)  =  P[t;£(t/t1_1)]P(t/t1_1)  + 

P(t/ti-i)FT[t;x(t/ti_i)]  +  G(t)Q(t)GT(t) 

(15) 

i 

to  be  integrated  from  t^  ^  to  t^  using  the  Initial  conditions 

where 

x  =  x(-t/t1_1) 

The  filter  update  equations  are 

K(t1)  =  P(t1“)HT[t1;x(t1”)]tH[t1;xCti“)]PCt1“)HT[t1;x(t1’)] 
+  R(t1)}  (16) 

x(t1+)  =  xCt1“)  +  K(t1)[Z(t1)  -  h[x Ct 1") , u(t 1 ) , t i ] ] 

(17) 

P(t1+)  =  PCt1")  -  K(t1)H[t1;x(t1")]P(t1^)  (18) 
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where 


x  =  xCt^) 

As  in  the  basic  Kalman  filter,  the  initial  conditions  are 
modelled  as  a  random  vector  x  with  mean  x(tQ)  and  covariance 
p(tc). 

Although  these  equations  appear  similar  to  the  propagation 
and  update  equations  given  in  Section  2.3  for  the  basic  Kalman 
filter  (Equations  (9)  -  (13)),  there  is  a  fundamental  differ¬ 
ence.  The  error  covariance  matrix  in  the  basic  Kalman  filter 
is  independent  of  the  measurements  and  the  estimated  values 
of  the  state  vector,  and  can  thus  be  precomputed  and  analyzed 
without  knowledge  of  the  actual  measurements.  The  error  co- 
variance  matrix  of  the  EKP,  on  the  other  hand,  is  dependent 
on  the  state  estimate  time  history  through  the  recomputed 
nominal.  This  point  is  significant  in  determining  a  method 
for  evaluating  the  Kalman  filter  algorithm,  and  will  be  dis¬ 
cussed  further  in  Chapter  4,  where  a  Monte  Carlo  analysis 


H[t1jx(ti")]  = 


3h[x,u(t1) , t ± ] 


3X 


will  be  described. 


»■ 

i 


t 


! 
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CHAPTER  III 
ALGORITHM  DEVELOPMENT 

> 

3.1  Introduction  J 

j 

This  chapter  will  discuss  the  development  of  the  six  algo- 

i 

rithms  evaluated  in  this  thesis.  The  purpose  of  these  algo¬ 
rithms  is  to  obtain  the  best  estimate  of  the  range  of  a  moving, 
airborne  target  from  a  moving,  airborne  tracker,  where  the 
tracker  is  measuring  only  azimuth,  elevation,  azimuth  rate,  and 
elevation  rate  of  the  line  of  sight  to  the  target.  Each  method 
attempts  to  arrive  at  a  solution  by  finding  a  target  range  and 
velocity  which  is  consistent  with  the  measured  angles  and  angle 
rates  coming  from  the  tracker,  a  problem  which  is  compounded  by 
noise  in  the  tracker  measurements  and  by  limited  adequacy  of 

I 

proposed  mathematical  models.  All  algorithms  are  based  on  ex¬ 
tended  Kalman  filters;  they  differ  in  their  state  vector  repre¬ 
sentation  and  target  motion  model  assumptions. 

It  should  be  noted  that  some  of  algorithms  use  nonlinear 
dynamics  equations  and  linear  measurement  equations,  while 
others  use  linear  dynamics  equations  and  nonlinear  measurement 
equations.  From  the  discussion  on  Kalman  filters,  one  can  see 
that  the  Implementation  of  the  former  algorithm  would  be  more 
burdensome  computationally  than  the  implementation  of  the 
latter,  since  some  kind  of  online  integration  routine  would 
have  to  be  used  for  propagation  in  the  case  of  nonlinear  dy¬ 
namics.  Therefore,  if  equal  performance  were  obtained  from 
these  two  types  of  algorithms,  the  second  would  be  the  better 
choice  from  the  standpoint  of  computational  loading. 
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it 


In  an  attempt  to  minimize,  if  not  eliminate,  the  con¬ 
fusion  caused  by  presenting  six  algorithms  using  different 
state  vectors  and  different  coordinate  systems,  the  second 
section  of  this  chapter  is  devoted  to  the  definition  of 
reference  frames  and  notation  conventions  which  will  remain 
in  effect  throughout  the  rest  of  the  thesis.  The  subsequent 
sections  of  this  chapter  will  present  in  detail  the  six 
algorithms  to  be  evaluated. 

« 

3.2  Reference  Frames  and  Notation 

There  are  four  different  reference  frames  used  in  the 
ranging  algorithms  to  be  evaluated;  three  frames  using 
Cartesian  coordinates,  differing  only  in  origin  and  orienta¬ 
tion,  and  the  fourth  frame  using  spherical  coordinates.  Be¬ 
cause  the  state  vector  of  the  six  algorithms  all  contain  states 
expressed  in  two  different  coordinate  systems,  it  is  impor¬ 
tant  to  understand  these  reference  frames  before  proceeding 
to  the  algorithm  descriptions.  The  four  reference  frames 
will  be  referred  to  as  inertial  north-east-down  (NED),  rela¬ 
tive  NED,  line  of  sight  (LOS),  and  spherical. 

3.2.1  Reference  Frames.  The  inertial  NED  frame  is  a 
Cartesian  coordinate  frame  which  is  oriented  so  that  the 
X,  Y,  and  Z  a:,  rs  point  north,  east,  and  down,  respectively. 

For  this  thesis,  north  is  defined  as  true  north,  down  in  de¬ 
fined  as  paraellel  to  local  gravity,  and  east  is  perpendicular 
to  the  other  two  axes  to  form  a  right-hand  orthogonal  coordinate 
system.  This  "reference  frame"  is  really  a  series  of  frames, 
each  of  which  is  fixed  with  respect  to  the  earth  and  oriented 
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north-east-down.  At  each  measurement  update  time,  the 
"inertial  NED"  frame  is  chosen  as  that  frame  in  the  series 
whose  origin  is  at  the  (attacking)  fighter  aircraft.  While 
these  frames  are  not  truly  inertial,  as  they  are  fixed  to  a 
translating,  rotating  earth,  they  can  be  considered  inertial 
over  the  relatively  short  times  and  distances  involved  in 
this  thesis. 

The  relative  NED  frame  differs  from  the  inertial  NED 

frame  in  that  the  relative  NED  frame  origin  is  always  located 

at  the  fighter  aircraft  and  translates  with  the  motion  of  the 

/ 

fighter.  The  axes  of  the  inertial  NED  frame  and  ;the  relative 
NED  frame  are  considered  to  be  aligned  at  the  sequence  of 
points  where  the  "inertial  NED"  frame  is  defined. 

The  statement  that  the  orientation  of  the  axes  in  both 
the  inertial  NED  frame  and  the  relative  NED  frame  are  always 
north,  east,  and  down,  implies  that  these  frames  must  rotate 
as  the  fighter  aircraft  moves  across  the  curved  surface  of 
the  earth.  Thus  at  the  instant  of  measurement  update,  the 
origin  of  the  Inertial  NED  frame  becomes  fixed  with  respect 
to  the  earth,  and  although  the  axes  of  the  relative  and  in¬ 
ertial  frames  are  aligned,  the  relative  frame  has  an  instan¬ 
taneous  rotation  rate  with  respect  to  the  inertial  frame 
about  an  axis  perpendicular  to  the  fighter  aircraft's  velocity 
vector  (assuming  a  spherical  earth).  This  rotation  rate  is 
relatively  small,  but  will  be  included  in  the  elevation  rate 
measurement  equations  of  the  ranging  algorithms. 

The  third  reference  frame  to  be  described  is  the  LOS 
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frame.  This  is  again  a  Cartesian  coordinate  system,  with 
the  axes  oriented  so  that  the  X  axis  points  along  the  line 
of  sight  from  the  fighter  to  the  target,  the  Y  axis  is  per¬ 
pendicular  to  the  X  axis  and  always  in  the  horizontal  plane, 
and  the  Z  axis  is  perpendicular  to  the  other  two  and  generally 
"down"  to  form  a  right-hand  orthogonal  coordinate  system 
(Figure  3-1)-  As  in  the  inertial  NED  frame,  the  LOS  frame 
can  be  thought  of  as  a  series  of  frames,  each  fixed  with  re¬ 
spect  to  the  earth.  At  measurement  update  time,  the  LOS 
frame  is  chosen  as  that  earth-fixed  frame  whose  axes  are 
aligned  as  described  above  and  whose  origin  is  at  the  fighter 
aircraft.  The  rotation  of  this  frame  is  thus  ignored,  as  in 
the  inertial  NED  frame.  This  is  less  valid  here,  however, 
because  the  rotation  of  the  axes  of  the  LOS  frame  is  caused 
by  the  relative  movement  of  the  target  and  the  fighter,  not 
just  the  curvature  of  the  earth's  surface.  The  errors  caused 
by  assuming  away  the  conceivably  large  rotation  rate  of  the 
LOS  frame  will  be  made  graphically  apparent  in  Chapter  5,  in 
which  the  algorithm  performance  is  discussed. 

The  last  frame  of  reference  considered  here  is  in  spheri¬ 
cal  coordinates,  with  the  origin  located  at  the  fighter  air¬ 
craft  and  translating  with  it.  Positions  in  this  reference 
frame  are  expressed  in  terms  of  a  distance  (R)  at  some  azi¬ 
muth  (0)  and  elevation  (y).  Azimuth  is  defined  as  the  angle 
in  the  horizontal  plane  between  the  north  axis  and  the  pro¬ 
jection  of  the  position  vector  onto  the  horizoptal  plane, 
measured  positive  clockwise  from  north;  elevation  is  the  angle 


< 

Figure 
Mote : 

I 
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3-1.  Line  of  Sight  Reference  Frame 

The  N  E,  and  YL0S  axes  are  in  the  horizontal 

*  '  t ns  t  ns 

(local  level)  plane.  The  X  ,7.  ,  and  D. 

axes  are  in  the  same  vertical  plane,  which  is 
offset  by  azimuth,  6,  from  the  N  axis. 
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between  the  horizontal  plane  and  the  position  vector,  mea¬ 
sured  positive  update  (Figure  3-2). 

3.2.2  Notation.  f,This  section  establishes  notation  and 
subscript  convention  which  will  be  used  throughout  the  rest 
of  the  thesis.  All  angles  and  angle  rates  will  be  expressed 
in  microradians  and  microradians  per  second,  respectively, 
unless  otherwise  noted.  The  coordinate  frame  in  which  the 
quantities  are  expressed  is  always  the  frame  with  respect  to 
which  the  time  derivative  is  taken;  i.e.,  velocity  coordina- 
tized  in  the  line  of  sight  frame  Implies  the  time  derivative 
of  position  with  respect  to  the  line  of  sight  frame. 

Position  is  spherical  coordinates  will  be  represented  as 
R' ,  0,  and  y ,  the  superscript  S  on  R  denoting  the  spherical 
frame.  The  time  derivatives  of  these  quantities  will  be 

•  Q  •  • 

written  as  R  ,  9,  and  y. 

Position,  velocity,  and  acceleration  in  the  Cartesian 
coordinate  systems  will  be  written  as  x,  y,  z;  Vx,  V  ,  V?; 
and  A^,  A^,  A^.  These  will  be  superscripted  with  I,  REL,  or 
LOS,  to  indicate  reference  to  the  inertial  NED  frame,  relative 
NED  frame,  or  line  of  sight  frame,  respectively.  Further, 
velocities  and  accelerations  will  have  a  second  subscript  of 

F  or  T  to  indicate  fighter  or  target  motion. 

LOS 

For  example,  V^p  indicates  fighter  velocity  with  respect 
to  the  LOS  frame  and  in  the  x  direction  of  the  LOS  frame; 

AyT  indicates  target  acceleration  with  respect  to  the  inertial 
NED  frame  and  in  the  y(east)  direction  of  the  inertial  NED 
frame . 
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Projection  of  position 
vector  on  horizontal  plane 


V 

D 


re  3-2.  Spherical  Frame 


Table  3-1  provides  a  summary  of  the  notation.  Position 
expressions  in  the  inertial  NED  and  the  LOS  frames,  and 
acceleration  in  the  relative  NED  frame,  are  omitted,  since 
they  are  not  used  in  any  of  the  evaluated  algorithms. 


Table  3-1  Notation  Summary 


Reference 

Frame 


Inertial  NED 


Relative  NED 


Line  of  Sight 


Spherical 


Position 


N/A 

N/A 

N/A 


Veloc ity 
( target ) 


Acceleration 
( fighter) 


3.3  Algorithm  Description 

3.3.1  Overview.  Section  3.3  describes  in  detail  the 
six  algorithms  which  are  tested  in  this  thesis.  The  algori¬ 
thms  are  numbered  from  one  to  six  in  the  order  in  which  they 
are  presented,  which  is  generally  in  order  of  decreasing  com¬ 
plexity.  Before  the  detailed  descriptions,  however,  a  brief 
overview  of  the  physi  ;al  reasoning  behind  the  target  models 
used  is  in  order. 

The  first  two  algorithms  model  target  acceleration  as  three 
independent  acceleration  processes,  each  the  output  of  a  first 
order  lag  driver  by  white,  Gaussian  noise.  Physically,  this 
means  that  target  acceleration  in  any  direction  is  time-cor¬ 
related  (the  target  cannot  accelerate  instantaneously)  and 
that  the  target  acceleration  in  any  direction  is  independent 
of  the  accelerations  in  the  other  two  directions.  In  some 
scenarios,  such  as  a  close-in  gun  tracking  solution,  for 
example,  it  may  be  possible  to  specify  a  target  model  with 
accelerations  which  are  independent  from  channel  to  channel 
in  the  LOS  frame  but  each  with  a  different  la  value.  If 
this  were  done,  these  accelerations  would  not  be  independent 
from  channel  to  channel  in  the  inertial  NED  frame  if  the 
inertial  NED  frame  and  LOS  frame  were  not  aligned.  In  this 
thesis,  the  strengths  of  the  white  driving  noise  and  hence  the 
lo  values  of  the  accelerations  of  the  three  channels  are 
assumed  equal,  so  that  the  target  models  are  equivalent  in 
the  inertial  NED  and  LOS  frames. 


This  is  a  very  flexible  target  model,  and  can  be  made 
to  match  a  wide  range  of  potential  targets  by  appropriate 


choices  for  the  time  constant  of  the  lag,  x,  and  the  strength 
of  the  dynamics  driving  noise,  Q(t)  (see  Section  3.^). 

In  fact,  because  the  accelerations  are  not  correlated 
with  target  velocity  (as  opposed  to  an  actual  aircraft,  which 
has  a  greater  acceleration  ability  in  a  direction  perpendi¬ 
cular  to  aircraft  velocity),  the  target  in  this  model  has  more 
freedom  of  movement  than  an  actual  target  would  have. 

The  target  model  used  in  algorithm  four  is  an  attempt  to 
limit  to  some  degree  the  target's  freedom  of  movement.  In 
this  model,  the  target  is  assumed  to  have  a  relatively  constant 
total  velocity  magnitude  (very  little  acceleration  along  the 
velocity  vector),  and  to  have  a  maneuver  capability  only  of 
turns  in  the  horizontal  plane.  This  is  physically  reasonable, 
as  aircraft  structural  limits  and  energy  management  considera¬ 
tions,  as  well  as  some  tactical  considerations,  tend  to  limit 
aircraft  motion  to  horizontal  maneuvers.  Heading  rate  in  this 
algorithm  is  modelled  as  Brownian  motion;  that  is,  the  time 
derivative  of  heading  rate  is  modelled  as  white,  zero-mean, 
Gaussian  noise: 

(a)  =  0  +  w ( t ) . 

Physically,  this  is  saying  that  the  target  has  a  basically 
constant  heading  rate  (with  wideband  noise  added  to  model 
the  inadequacy  of  a  completely  constant  rate  assumption),  or 
is  essentially  in  a  constant  airspeed,  constant  g  horizontal 
turn.  V/hile  heading  rate  could  have  been  modelled  in  the 
same  way  as  the  accelerations  in  algorithms  one  and  two,  it 


was  felt  that,  considering  the  relatively  small  heading  rates 
really  Involved  and  the  speed  with  which  they  could  be  changed, 
this  would  needlessly  complicate  the  algorithm.  Section  3.^ 
explains  the  method  for  finding  the  correct  strength  for  the 
white  noise. 

Algorithms  three  (so  numbered  because  of  its  similarity 
to  algorithm  two),  five,  and  six  limit  target  motion  still 
further,  with  velocity  modelled  as  Brownian  motion  in  the 
same  manner  as  heading  rate  above,  i.e.,  V(t)  =  0  +  w(t). 

Again,  time  correlation  was  not  modelled,  as  the  velocity  is 
expected  to  be  basically  constant,  and  the  addition  of  a 
first  order  lag  would  needlessly  complicate  the  algorithm. 

The  target  in  this  case  is  limited  to  flying  in  basically  a 
straight  line,  with  small  excursions  handled  by  the  noise. 

The  determination  of  appropriate  values  for  Q(t),  the  strength 
of  the  noise,  is  discussed  in  Section  3 • ^ • 

In  all  algorithms,  the  fighter  aircraft  motion  is  assumed 
to  be  known  perfectly  from  its  inertial  navigation  system. 

While  this  is  not  a  completely  accurate  representation,  it  is 
a  reasonable  assumption  considering  the  short  times  and  dis¬ 
tances  involved  in  this  problem,  and  the  relative  precision  of 
the  INS  data  and  data  from  the  tracking  sensor.  If  this  assump¬ 
tion  were  used  in  actual  algorithm  implementation,  considera¬ 
tion  may  be  given  to  adding  a  small  amount  of  pseudonoise  to 
"tell  the  filter"  that  these  measurements  are  not  really 
precise . 
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3.3.2  Algorithm  One.  The  first  algorithm  employs  a 
state  vector  in  which  position  and  velocity  are  expressed  in 
the  spherical  coordinate  frame,  while  target  acceleration  is 


expressed  in  the  LOS  frame.  This  allows  target  acceleration 


to  be  modelled  with  respect  to  the  earth,  since  the  LOS  frame 
as  defined  here  is  earth-fixed,  while  position  and  velocity 


in  the  spherical  frame  are  relative  to  the  fighter  aircraft. 


This  leads  to  a  state  vector  of 


where  the  elements  are  as  defined  in  Section  3.2.2. 

In  this  approach,  as  previously  mentioned,  we  will  assume 
that  the  Cartesian  target  acceleration  is  well  modelled  as 
three  independent  acceleration  processes,  each  the  output  of  a 
first  order  lag  driven  by  white,  Gaussian  noise.  In  order  to 
write  out  the  dynamics  equations,  however,  we  must  find  a 

"Q  ” 

way  to  relate  R  ,  0,  and  y  to  the  other  elements  of  the  state 
vector.  We  will  do  this  by  defining  a  vector  R  to  be  the 
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position  vector  of  the  target  aircraft  relative  to  the 
fighter  aircraft,  and  differentiating  twice  with  respect  to 
time  as  seen  in  the  LOS  frame.  (This  development  parallels 
one  by  R.A.K.  Mitchell,  Ref  7,  pp  19-21). 

Letting  u  be  the  angular  velocity  of  the  spherical  frame 
with  respect  to  the  LOS  frame,  which,  again,  is  considered 
inertial,  we  can  use  the  Theorem  of  Coriolis  to  write 


d2R 

2 

d  R 

,  O  dR 

+  2w  x  _= 

da) 

+  zZ 

2 

, .  2 

dt 

dt 

dt 

dt 

LOS 

S 

S 

+  (o  x  ( w  x  R)  (19) 

where  the  vertical  line  denotes  the  frame  in  which  the  deriva¬ 
tive  is  taken  (7:19). 

The  left  side  of  Equation  (19),  when  written  in  LOS 
coordinates,  is  the  relative  acceleration  of  the  target  with 
respect  to  the  fighter,  or 


If  expressed  in  the  LOS  frame  in  terms  of  azimuth  and 
elevation  rate,  w  can  be  written  as  (See  Figure  3-3): 


LOS 

M 


(21) 
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Figure  3-3-  Rotation  Rate  in  the  LOR.  Frame 

a)  In  the  YL0S  -  D  plane 

b)  In  the  XL0S  -  D  plane 

2  b 


Additionally,  because  the  position  vector  R  lies  com¬ 
pletely  along  the  X  axis  in  the  LOS  frame,  and  in  spherical 
coordinates  lies  along  the  same  line,  we  can  write 


d2RL0S 


(22a) 


(22b) 


(22c) 


Substituting  into  Equation  (19)  and  taking  the  cross 


products  yields 


"S  DS ‘ 2  WS  2  '2 
R  -  R  y  -  R  cos  yd 


3  •  •  •  c 

R  ( 9cosy  -  20YsinY)  +  2R  cosy© 


-RS  (y  +  cosYsinY0^)  -  2RSy 


Manipulating  to  Isolate  R  ,  0,  and  y,  and  expressing  the 
angles  in  microradians  gives 


RS  =  A^°S  -  A^pS  +  RSy2  x  1012+  P.S 0 2  cos2 y  x  10"12 


(2Aa) 
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(ay?S-aypS)x1°6 

Is 

R  cosy 


’  R  ‘ 

PP  A  •  •  C 

-  +  2y Qtany  x  10"° 


(24b) 


ft“S-A“S)xl°6 


2RSy  62sln2YxlO~6 


(24c) 


The  above  equations  form  the  basis  for  the  dynamics  equa¬ 
tions  for  algorithm  one.  Before  going  on,  however,  the  dis¬ 
crepancy  of  the  "inertial"  LOS  frame  which  remains  aligned  with 
a  moving  position  vector  should  again  be  noted.  The  LOS  frame 
is  not  truely  Inertial;  it  is  assumed  that  it  is  approximately 
inertial  for  relatively  small  elevation  and  azimuth  rates, 
such  as  would  occur  if  the  fighter  aircraft  were  on  a  near 
collision  course  with  the  target. 

The  dynamics  equation  vector  to  be  used  in  Equation  (3) 
for  this  algorithm  is  given  by 


f [ x ( t ) , u ( t ) ,t]= 


.LOS  .  LOS  /  dS’2,dS’2  2  .  in-12 

AXT  -AXF  +  R  Y  +R  9  COS 


1  .LOS 
~t  XT 


(AR£S-AvSS)xl06/(RScosY)-2RSe/RS+2Y0tanYxl0-6 
ii  ir 


1  .LOS 
x  YT 


(AZTS"AZFS)xl°6/RS'2RSY/RS_®2sln2YXl°D/2 

-I  alos 
T  azt 
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Examination  of  Equation  (25)  reveals  that  the  angle  6 
is  not  used  in  any  of  the  equations  in  the  vector,  and  y  is 
used  only  as  the  argument  of  trigonometric  functions.  It  is 
reasonable  to  assume  that,  given  inertial  angle  measurement 
accuracy  of  1  milliradian  or  better,  we  could  delete  the 
angles  6  and  y  from  the  state  vector  and  simply  use  the 
measured  angle  y  in  the  propagation  equations  for  the  other 
states.  Again,  since  0  does  not  appear  in  any  of  the  propa¬ 
gation  equations,  this  can  obviously  be  deleted  with  no 
effect.  The  introduction  of  the  noisy  elevation  measurement 
directly  into  the  equations,  however,  will  cause  some  error 
in  the  target  state,  and  may  require  the  addition  of  pseudonoise 
in  those  channels  in  which  y  is  used  (in  the  propagation  of 

•  o' 

FT  ,  0,  and  y).  The  new  state  vector  is 
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The  dynamics  equation.  Equation  (3),  written  in  vector 
form,  becomes 
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(26) 


Since  the  measurements  coming  from  the  sensor  are  inertial 
angle  rates,  we  are  actually  measuring  states  four  and  six  of 
the  state  vector  directly.  Thus  the  measurement  equation. 
Equation  ( 4 ) ,  becomes 
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where  ur  is  the  rotation  rate  of  the  spherical  reference 
►  L 

f  frame  with  respect  to  the  LOS  frame,  caused  by  fighter  velo¬ 

city  over  the  curved  surface  of  the  earth,  as  discussed  in 
'  Section  3.2.1.  w  in  microradians/second,  is  defined  by 
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(27b) 
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uc  =  (V*p  cos  0  +  Vyp  sin  0)  X  106/Re 

where  is  the  radius  of  the  (assumed  spherical)  earth.  Note 
that  when  spherical  coordinates  are  used  in  the  state  vector 
to  express  position  and  velocity,  the  dynamics  equations  are 
nonlinear,  while  the  measurement  equations  are  linear.  We 
will  see  that  the  opposite  is  true  when  the  state  vector  is 
expressed  entirely  in  Cartesian  coordinate  frames.  As  men¬ 
tioned  previously,  given  equal  performance  of  these  two 
algorithms,  computational  loading  considerations  would  lead 
toward  the  choice  of  linear  dynamics  and  nonlinear  measurements. 

The  EKF  propagation  and  update  equations  are  given  by 
Equations  (14)-(18),  with  Equation  (26)  and  (27)  describing 
the  appropriate  dynamics  vector  and  measurement  vector,  re¬ 
spectively  . 

The  G,  F,  and  H  matrices  needed  for  implementation  are 
given  in  Appendix  A;  the  selection  of  appropriate  values  for 
the  Q  and  R  matrices  and  the  time  constant  t  are  discussed  in 
Section  3 • ^  • 

3.3.3  Algorithm  Two.  The  state  vector  used  in  the  se¬ 
cond  algorithm  is  expressed  entirely  in  Cartesian  coordinate 
frames:  target  position  and  velocity  in  the  relative  NED 

frame,  and  target  acceleration  in  the  inertial  NED  frame. 

As  in  algorithm  one,  target  acceleration  is  with  respect  to 
an  earth-fixed  reference  frame,  hopefully  leading  to  a  more 
accurate  target  model. 
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The  state  vector  is 


X 


Target  acceleration  is  modelled  again  as  three  independent 
acceleration  processes,  each  the  output  of  a  first  order  lag 
driven  by  white,  Gaussian  noise.  The  dynamics  equations  for 
this  algorithm  are  linear  and  relatively  simple,  and,  written 
in  vector  form,  are  fxREL]  fvREL  1  fa  1 
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It  should  be  pointed  out  that  in  actual  implementation, 
pseudonoise  could  be  added  to  the  velocity  channels  because 
the  fighter  accelerations  are  not  really  perfectly  known. 

The  measurement  equations  for  this  algorithm  are  some¬ 
what  more  complex.  Figure  3-^  shows  the  relationship  between 
the  relative  NED  frame  and  the  position  vector  to  the  target. 
The  angles  0  and  y,  and  the  angle  rates  0  and  y>  are  the 
measurements  which  are  input  to  the  filter  algorithm  from 
the  tracker.  From  Fig -re  3-1*  we  can  see  that,  in  microradians. 
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By  either  calculating  the  time  derivatives  of  Equation 
(29)  and  (30),  or  by  finding  the  velocities  required  to  cause 
angle  rates  of  G  and  y  from  Figure  3-3,  we  can  see  that 
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again  expressed  in  microradians/second. 

Thus,  in  vector  form,  the  measurement  equations  are 


(33) 

where  w c  is  the  correction  term  for  fighter  movement  over  the 
earth,  as  discussed  in  Section  3*2.2,  Equation  (27b). 

In  order  to  estimate  the  target  position  in  the  relative 
NED  frame,  the  filter  must  be  given  the  angle  measurements 
as  well  as  the  angle  rates.  This  makes  the  measurement  vector 
a  vector  of  dimension  four  rather  than  two,  as  in  algorithm 
one . 

In  implementing  this  algorithm,  an  effort  was  made  to 
minimize  the  errors  caused  by  linearizing  the  inverse  tangent 
function  in  the  first  two  measurements  by  adding  bias  correc¬ 
tion  terms  to  the  residual  calculations  (6:224).  These  terms 
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were  added  in  the  angle  measurement  residual  calculations 
and  not  in  the  angle  rate  measurement  residual  calculations 
of  this  and  other  algorithms  because  it  was  believed  that 
the  degree  of  nonlinearity  of  the  inverse  tangent  function 
warranted  their  addition  while  the  other  measurement  equa¬ 
tions  did  not.  The  bias  correction  terms  appear  in  the  EKP 
state  vector  update  equation,  and  change  Equation  (17)  to 

X(t1+)=X(ti")+K(t1)[Z(t1)-h[X(t1"),u(ti),ti]-bffl(t1‘)] 

(34) 

where  b  (t^  )  is  a  vector  of  dimension  m  whose  k  component 
is  given  as 


(35) 
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This  has  the  effect  of  correcting  for  nonlinearities  in 
,u(t^)  ft-^]  by  bringing  in  second  order  terms  without 
going  to  a  fully  developed  second  order  filter. 

The  remaining  matrices  required  for  implementation  are 
given  in  Appendix  B;  the  selection  of  appropriate  values  for 
Q(t),  R(t^),  and  x  is  covered  in  Section  3.4 

It  should  be  noted  that,  because  range  is  a  nonlinear 
function  of  the  estimated  states  X^^,  ancj  Z  we 

Instead,  the 
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cannot  simply  say  that  R=/  X  +Y  +Z 


equation  R 
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must  be  expanded  is  a  Taylor 


series  about  the  estimated  values  of  XREE,  yREL,  and  ZREE, 
and  then  the  expected  value  taken  of  both  sides. 

Following  this  procedure,  it  was  found  that  calculating 
range  by  taking  the  square  root  of  the  sum  of  the  square  of 


XREL  +yREL  +zREL  ,  differed 


-A] 

the  Cartesian  estimates,  R=/  X 
from  the  series  expansion  range  estimate  by  only  approximately 
0.01  feet  in  all  calculations  throughout  the  test  run.  The 
simpler  calculation  of  the  range  estimate  is  therefore  used 
in  both  this  algorithm  and  the  following  algorithm. 

3. 3- ^  Algorithm  Three.  Algorithm  three  is  basically  a 
simplified  form  of  algorithm  two,  in  which  target  acceleration 
is  modelled  as  three  independent  zero  mean,  white,  Gaussian 
noises,  rather  than  three  first-order  Gauss  Markov  processes, 
as  in  algorithm  two.  The  state  vector  is  similar  to  that  of 
the  preceedlng  algorithm,  with  acceleration  deleted  and  target 
velocities  expressed  in  inertial  NED  coordinates.  The  state 
vector  is 
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The  dynamics  equations,  in  vector  form,  are 


Physically,  this  dynamics  model  is  saying  that  the  tar¬ 
get  is  flying  in  a  basically  straight  line  in  the  inertial 
NED  frame.  The  additive  noise  allows  for  small  target  maneu¬ 
vers  and  prevents  the  elements  of  the  error  covariance  matrix, 
and  hence  the  gain  matrix  in  the  update  equations,  from  going 
to  zero. 

The  measurement  update  equations  for  this  algorithm  are 
given  by  Equation  (33),  where  the  target  velocities  in  the 
relative  NED  frame  are  calculated  by  subtracting  fighter  inertial 
velocity  from  target  inertial  velocity,  so  that 


The  bias  correction  terms  given  by  Equation  ( 34 )  and  (35) 
are  also  used  with  algorithm  three.  The  other  matrices  needed 
for  implementation  are  given  in  Appendix  C;  Q  and  R  are  dis¬ 
cussed  in  Section  3.4. 


3.3.5  Algorithm  Four.  The  state  vector  of  algorithm 

S 

four  is  made  up  of  range  R  in  the  spherical  coordinate  system, 
target  total  velocity,  target  heading,  and  target  heading  rate. 
The  target  motion  is  considered  to  be  entirely  in  the  plane 
of  the  target's  local  horizon;  that  is,  the  target  is  assumed 
not  to  be  changing  its  altitude.  The  reasoning  behind  this 
choice  of  states,  as  discussed  in  the  overview,  is  to  provide 
the  filter  with  a  target  model  with  maneuver  capability  some¬ 
where  between  the  very  flexible  model  of  algorithms  one  and 
two  and  the  very  constrained  models  of  algorithms  three,  five, 
and  six.  Physically,  the  target's  total  velocity  will  not 
change  very  quickly;  most  of  the  acceleration  will  be  perpen¬ 
dicular  to  the  target's  flight  path,  and  mostly  in  the  horizon¬ 
tal  plane  (the  target  is  performing  constant  airspeed  horizon¬ 
tal  turns ) . 
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where  V  =  target  total  velocity 

a  =  target  heading,  measured  the  same  was  as  0 
a  =  target  heading  rate 

Figure  3-4  shows  the  geometry  of  the  intercept  looking 
down  from  above  the  two  aircraft.  Because  of  the  measured 
elevation  difference  between  the  target  and  the  fighter  (y, 
measured  as  described  in  Section  3.3.3,  Figure  3-3)  and  the 
curvature  of  the  earth,  there  is  an  angular  difference  between 
the  local  horizontal  of  the  target  (the  assumed  plane  of 
motion)  and  the  local  horizontal  of  the  fighter  (with  respect 
to  which  the  measurements  are  taken)  which  can  be  approximated 

S 

by  y  +  R  /R  ,  where  Rg  is  the  radius  of  the  earth. 

From  Figure  3-4,  it  can  be  seen  that  the  component  of 

S 

the  target's  velocity  which  causes  a  positive  change  in  R 

3 

is  V  cos  (r-a+e)  cos  (y+R  /Rg).  The  dynamics  equations  can 
thus  be  written 

os(Ti-(a-e)xlO"6)cos(yxlO~6+RS/Re)-V^°S  0 

W 

+ 

0 

w 

(38) 
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where,  as  previously  defined,  Vxp  represents  fighter  inertial 

LOS 

velocity  in  the  X  direction,  or  along  the  line  of  sight. 

The  factors  of  10"*^  in  Equation  (38)  are  due  to  expressing 
the  angles  in  microradians. 

The  measurements  used  in  this  algorithm  are  azimuth  rate 
and  elevation  rate;  it  is  again  assumed  that  the  azimuth  and 
elevation  angle  measurements  are  accurate  enough  that  they 
can  be  used  directly  in  the  propagation  and  update  equations, 
which  again  suggests  the  possible  addition  of  pseudonoise, 
although  that  was  not  done  here.  In  implementation,  in  order 
to  minimize  errors  caused  by  the  changing  of  8  and  y  during 
the  propagation  period,  the  angles  used  as  constants  for  the 
entire  time  of  propagation  (T)  are  calculated  in  the  following 
manner: 


=  0  +  O.5T0 

(39a) 

=  y  +  0 . 5Ty 

(39b) 

where  8,  y,  8,  and  y  are  the  angle  and  angle  rate  measure¬ 
ments  at  the  beginning  of  the  propagation  period.  Other  pos¬ 
sibilities  exist  for  correcting  this  error,  but  this  is  a 
simple  method  often  used  to  enhance  Euler  integrations  con¬ 
siderably  with  little  expense. 
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The  measurement  equations  for  this  algorithm  can  be 


written  as 
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;re  is  defined  by  Equation  (27b). 


The  remaining  matrices  required  for  implementation  are 
found  in  Appendix  D;  the  Q  and  R  matrices  are  discussed  in 
Section  3-4. 


3.3-6  Algorithm  Five.  Algorithm  five  uses  a  state  vec¬ 
tor  composed  of  range  in  the  spherical  coordinate  frame  and 
target  velocities  in  the  inertial  NED  frame.  This  state  vec¬ 
tor  can  be  written  as 


The  component  of  target  velocity  which  would  cause  a 


S  II 

positive  change  in  R  can  be  written  as  (Vyr71cos6  'VYTsin0  ' ) cosy '  + 
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V^siny',  where  9*  and  y"  are  9  and  y  expressed  in  radians. 
The  dynamics  equations  in  vector  form  are 
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(41) 

The  measurement  equations  are,  as  before,  noise  corrupted 
version  of  9  and  y: 
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A  variation  of  this  algorithm  was  used  to  enhance  con¬ 
vergence  during  the  testing  of  this  and  the  following  algo¬ 
rithms.  A  similar  variation  would  probably  help  the  previous 
algorithms  also,  but  was  not  included  simply  because  they  were 
not  tested  in  the  detail  of  algorithms  five  and  six.  This 
variation  adds  noise  to  the  first  channel  of  the  filter, 
in  addition  to  the  noise  is  the  velocity  channels,  thus 


making  the  noise  vector  in  Equation  (.41) 


The  reasoning  behind  this  change  will  be  discussed  in  great 
detail  in  Chapter  5,  which  covers  the  results  of  the  testing. 

Selection  of  values  for  Q  and  R  is  explained  in  Section 
3.^;  the  rest  of  the  matrices  needed  for  implementation  are 
given  in  Appendix  E. 

3.3.7  Algorithm  Six. (3)  This  method  is  very  similar 
to  algorithm  five,  the  only  difference  being  in  the  frame  of 
reference  in  which  target  velocity  is  expressed.  In  algorithm 
six,  target  velocity  is  written  in  the  LOS  frame,  giving  a 


Because  target  velocity  is  already  written  in  the  LOS 

3 

frame,  which  is  aligned  with  R  ,  the  dynamics  and  measurement 
equations  are  relatively  simple.  The  dynamics  equations  are 


(43) 


The  measurement  equations  are  noisy  versions  of  0  and  y: 
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As  in  the  previous  algorithm  noise  was  added  to  the  range 
channel  at  specified  times  to  aid  convergence.  See  Chapter 
rj  for  a  further  discussion  of  this. 

This  algorithm  is  simpler  than  algorithm  five,  but  the 
problem  is  that  while  algorithm  five  models  target  motion  as 
a  straight  line  in  Inertial  NED  coordinates,  algorithm  six 
models  target  motion  as  a  straight  line  in  LOS  coordinates. 
If  the  target  is  truly  flying  a  constant  heading,  the  algo- 


rithm  five  model  is  the  more  accurate.  Based  on  the  mathematical 
models,  one  would  expect  the  algorithm  six  model  to  be  approxi¬ 
mately  as  good  as  algorithm  five  in  scenarios  in  which  the 
angle  rates  are  close  to  zero,  such  as  when  the  range  to  the 
target  is  large  or  when  the  fighter  is  on  approximately  a 
collision  course  with  the  target.  The  relative  advantages  of 
these  two  approaches  will  be  discussed  further  in  Chapter  5. 

The  G,  H,  and  F  matrices  needed  to  implement  this  algori¬ 
thm  are  given  in  Appendix  Fj  the  Q  and  R  matrices  are  dis¬ 
cussed  in  the  Section  3-4. 

3 .  Determination  of  Values  for  Q(t),  R(tj),  and  t 

This  section  explains  the  initial  selection  of  values 
for  the  Q(t)  matrix  associated  with  the  dynamics  noise,  the 
measurement  noise  covariance  matrix  R(ti),  and  t,  the  time 
constant  used  in  algorithms  one  and  two.  The  noise  K(t.)  is 
input  to  the  dynamics  equations  of  the  six  algorithms  in  one 
of  two  ways:  as  the  input  to  a  first  order  lag  (algorithms 
one  and  two),  or  as  the  input  to  an  integration  with  no  feed¬ 
back  (algorithms  three  through  six).  The  determination  of  Q(t) 
for  these  two  cases  is  discussed  separately  in  Section  3*4.1 
and  3.4.2.  In  both  cases,  the  Q ( t )  obtained  is  only  a  reason¬ 
able  first  guess  at  what  Q(t)  should  be;  this  first  guc-ss  may 
be  further  tuned  during  the  testing  process,  as  explainer!  in 
Chapter  4  and  5 . 

3.4.1  Determination  of  Q(t)  and  t  for  Algorithms  Cne 
and  Two.  In  algorithms  one  and  two,  where  acceleration  is 


modelled  as  the  output  of  a  first  order  lag  driven  by  white 
Gaussian  noise,  values  selected  for  Q(t)  and  t  depend  on  the 
types  of  maneuvers  anticipated  from  the  target.  In  general, 
one  would  expect  a  lighter-type  aircraft  target  to  have  a 
small  t  and  ^arge  diagonal  values  in  Q(t),  when  compared  to  a 
bomber  or  transport  target.  The  fighter  aircraft  is  capable 
of  higher  acceleration  (large  Q(t))  and  of  changing  its  accelera¬ 
tion  more  quickly  (small  t). 

Because  the  Q(t)  associated  with  a  particular  anticipated 

target  acceleration  is  a  function  of  x,  a  value  for  x  must 

first  be  selected.  In  this  thesis,  x  will  be  set  equal  to  1.0 

seconds.  This  x  approximates  the  types  of  reactions  expected 

from  a  fighter  type  target.  For  a  scalar,  first  order  lag 

shaping  filter,  it  can  be  shown  (5:185)  that  the  appropriate 

noise  strength  Q(t)  to  provide  a  stationary  shaping  filter 

2 

output  of  mean  squared  value  oa  in  steady  state  is 

Q ( t )  =  Q  =  2a  2/t  (45) 

a. 

Assume,  for  example,  that  the  target  is  modelled  such  that, 

with  a  probability  of  .998,  it  will  pull  no  more  than  5  g's, 

2 

where  1  g  :  32.16  ft/sec  .  If  the  acceleration  is  assumed 

2 

Gaussian,  .998  corresponds  to  a  3o  value,  and  o  can  be  cal- 
culated  as  [4(32. 16)]2  =  2875  ft2/sec  .  In  this  case,  equa¬ 
tion  (45)  yields  Q(t)  =  5750  ftVsec'\ 

The  dynamics  driving  noises  on  the  acceleration  channels 
are  assumed  to  be  uncorrelated,  which  physically  says  that 
acceleration  in  one  direction  does  not  depend  at  all  on  the 


acceleration  in  either  of  the  other  directions.  This  is  not 
truly  representative  of  probable  target  motion;  there  actually 
are  correlations  which  we  are  assuming  to  be  zero  because 
of  the  difficulty  in  computing  accurate  off-diagonal  terms. 
Therefore,  assuming  independent  driving  noises,  the  Q ( t ) 
matrix  for  algorithms  one  and  two  is  a  3x3  diagonal  matrix 
with  the  computed  values  for  the  scalar  Q(t)  on  the  diagonal. 

3.^.2  Determination  of  Q(t)  for  Algorithms  Three  Through 
Six .  Algorithms  three  through  six  model  target  motion  such 
that  acceleration  is  itself  zero,  plus  a  small  amount  of 
pseudonoise  which  is  zero-mean,  Gaussian,  and  white,  or 

V(t)  =  0  +  W(t)  (46) 

where  V(t)  represents  the  scalar  velocity  in  one  direction. 

It  can  be  shown  that,  for  this  type  of  model,  given  E[Vt'(tQ)]  = 
0,  (6:134) 

E[V2(t)]  =  Q  •  (t-tQ)  (4?) 

where  Q  =  Q(t)  =  constant  strength  of  the  noise  V/(t  ). 

Thus,  to  find  a  value  for  Q,  we  simply  divide  *'r,o  desired 
variance  in  velocity  by  the  time  over  which  the  variance  occurs 
Physically,  we  are  saying  that  the  change  in  the  tamer's  velo¬ 
city  over  a  one  second  interval  is  node] led  as  a  Gaussian  ran- 
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dotn  variable  with  mean  zero  and  variance  of  Q  •  (t-t  )  ft' /sec1" 

O 

For  example,  assume  that  the  target  velocity  in  a  certain 


direction  will  change  over  a  one  second  interval  by  less  than 
100  ft/sec  with  a  probability  of  .998.  As  seen  previously. 


we  can  find  a  value  for  oy  of  33-33  ft/sec,  so  that  Q  = 

1111.11  ft2/sec3. 

An  alternate  method  would  be  to  choose  a  value  for  the 
Q  of  a  stationary  white  noise  so  that  this  height  matches 
the  height  of  the  observed  power  spectral  density  of  the  time 
correlated  acceleration  at  low  frequency.  This  method  In¬ 
volves  a  knowledge  of  power  spectral  densities  and  will  not 
be  fully  explained  here. 

It  should  be  noted  again  that  this  is  a  first  guess  at 
a  value  for  Q(t),  and  it  may  be  revised  during  subsequent 
tuning. 

3-^-3  Determination  of  R(tj).  The  RCt^)  matrix  is  per¬ 
haps  the  easiest  to  find  and  to  understand  physically.  In 
all  algorithms  it  Is  assumed  that  the  measurement  noises  are 
Independent,  white,  Gaussian,  zero-mean,  discrete-time  noise 
processes.  The  assumed  independence  of  the  noises  physically 
means  that  an  error  in  any  measurement  will  have  no  correla¬ 
tion  with  an  error  In  any  other  measurement.  It  seems  reason¬ 
able  that  this  would  be  the  case  in  seperating  azimuth  errors 
from  elevation  errors;  and,  if  rates  are  measured  in  another 
way  than  differentiating  the  angle  measurements  (a  rate  gyro, 
for  example),  it  also  seems  reasonable  that  angle  measurements 
would  be  Independent  from  their  corresponding  rate  measurements 

As  in  the  case  of  the  dynamics  noise,  this  is  knowingly 
mismodelling  the  measurement  model,  as  there  undoubtedly  are 
off-diagonal  terms  in  the  actual  RCt^)  matrix.  However,  due 
to  the  difficulty  of  finding  these  off-diagonal  terms,  it  is 


assumed  that  R(ti)  will  always  be  diagonal.  Further,  the 
values  of  the  diagonal  components  of  R(t^)  can  be  set  as  the 
variance  of  the  associated  elements  of  the  measurement  noise 
vector.  For  example,  if  an  element  of  the  VCt^)  vector  is  a 
noise  with  standard  deviation  a  =  1000  yrad/sec  being  added 
to  a  bearing  rate  measurement,  then  the  associated  diagonal 

L T  0  0 

term  of  R(t^)  would  be  10  yrad/sec  . 

In  the  evaluation  of  the  six  algorithms,  R(t.)  will  be 

varied  to  analyze  the  effect  of  sensor  accuracy  on  algorithm 

performance.  The  diagonal  terms  of  R(t^),  however,  will 

2 

always  reflect  the  a  value  of  the  measurement  errors  in  the 
sensor,  which  are  assumed  to  be  given.  Thus  there  is  never 
any  mismodelling  between  the  filter  R(t^)  and  the  true  R(t^) 
This  mismodelling,  and  the  robustness  of  the  filter  in 
handling  such  mismodelling,  is  not  addressed  in  this  thesis. 


CHAPTER  IV 


METHOD  OF  EVALUATION 

4.1  The  Monte  Carlo  Simulation 

In  evaluating  the  performance  of  a  particular  algorithm, 
what  we  are  really  looking  for  is  the  statistical  behavior 
of  the  errors  in  the  EKF« — generated  state  estimates  as  a  func¬ 
tion  of  time.  If  the  dynamics  and  measurement  equations  were 
all  linear,  this  could  be  done  via  a  covariance  analysis  in 
which  specific  measurement  realizations  need  not  be  simulated; 
however,  since  all  algorithms  evaluated  in  this  study  have 
nonlinearities  in  either  the  dynamics  or  the  measurements,  we 
must  resort  to  the  ensemble  averaging  of  many  test  runs  to 
obtain  the  statistics  of  the  error  process.  This  procedure 
is  known  as  a  Monte  Carlo  simulation  (5:335-341). 

Figure  4-1  shows  the  overall  structure  of  the  Monte  Carlo 
analysis.  The  truth  model  generates  an  accurate  representation 
of  the  signal  process  Z,  or,  in  other  words,  the  true  measure¬ 
ments.  In  this  thesis,  the  truth  model  is  based  on  data 
generated  by  a  computer  program  called  PR0FGEN(8).  PROFGEN 
creates  two  files  of  trajectory  data,  one  for  the  fighter  and 
one  for  the  target,  each  containing  aircraft  position,  velocity, 
and  acceleration  information  at  1/15  second  intervals.  The 
trajectories  are  deterministic  and  based  on  parameters,  input 
to  PROFGEN  (see  Chapter  5  for  specific  trajectories  evaluated). 
The  trajectory  data  is  read  by  the  truth  model,  which  computes 
the  target  position  and  motion  relative  to  the  fighter,  com- 


putes  the  true  measurements,  corrupts  these  measurements  with 
noise,  and  hands  the  noise-corrupted  azimuth  and  elevation 
(for  algorithms  two  and  three),  and  azimuth  rate  and  elevation 
rate  (for  all  algorithms)  to  the  filter  as  measurements.  Thus 
the  Z  being  input  to  the  EKP  in  Figure  4-1  is  a  simulation 
of  an  actual  measurement  at  a  given  time  for  the  given  two 
trajectories.  The  Kalman  filter  algorithm  processes  these 
simulated  measurements  and  generates  an  estimate  of  the  tar- 
get  state  vector,  x,  which,  when  differenced  with  the  true 
target  state  vector,  xfc,  yields  one  realization  of  the  error 
process  at  a  particular  time,  ( t ^ ) .  (In  the  cases  evaluated 
here,  the  truth  model  generates  a  truth  vector  which  is  the 
same  dimension  as  x,  thus  permitting  direct  differencing;  this 
is  not  generally  the  case  (5:326-336).  Additionally,  it  should 
be  noted  that  the  Kalman  filter  software  implementation  used 
the  fifth-order  Kutta-Merson  integration  routine  found  in 
S0FE(9)  to  integrate  the  state  vector  and  covariance  matrix 
propagation  equation,  even  in  the  case  of  linear  dynamics.) 

The  Monte  Carlo  analysis  takes  the  ensemble  average  of  a  num¬ 
ber  of  runs  to  determine  the  sample  statistics  of  the  error 
process,  e^ . 

In  this  thesis,  the  statistics  calculations  and  plotting 
are  done  by  a  software  program  entitled  SOFEPL(lO).  The 
plots  generated  by  SOFEPL  contain  the  mean  of  the  error,  the 
mean  of  the  error  plus  and  minus  one  standard  deviation  of 
that  mean,  and  the  positive  and  negative  square  root  of  the 
appropriate  diagonal  term  of  the  filter-generated  error  eo- 
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variance  matrix  (see  Figure  4-2).  This  type  of  plot  gives  a 
good  indication  of  the  filter's  performance  and  makes  tuning 
the  filter  relatively  straightforward.  In  general,  the  mean 
error  curve  should  remain  within  the  +  /P"^  envelope,  and  the 
mean  error  plus  and  minus  one  standard  deviation  curves  of  the 
errors  should  roughly  match  the  +  /P  ^  curves  (refer  to  Figure 
4-2) . 

Ten  runs  are  made  in  eaph  Monte  Curio  analysis.  This 

number  was  chosen  by  comparing  the  results  of  the  analysis 

i 

when  using  5,  10,  and  20  runs,  looking  for  the  point  where  the 

computed  statistics  remain  the  same  as  the  number  of  runs  is 

increased.  In  an  effort  to  conserve  computer  resources,  and 
because  there  was  very  little  difference  between  the  results 
from  10  runs  and  the  results  from  20  runs,  it  was  decided 
that  10  runs  would  be  sufficient. 

4.2  Sampling  Rates  and  Sensor  Noises  Tested 

In  order  to  limit  the  scope  of  this  study  to  within 
reasonable  bounds,  the  ranges  of  the  measurement  sample  rate 
and  the  sensor  noises  to  be  tested  had  to  be  limited.  The 
sample  rate  was  held  constant  at  1  Hz  throughout  the  tests. 
This  rate  Is  reasonable  if  the  sensor  is  in  a  full  track  mode. 
The  sensor  noise  standard  deviations  vary  from  1  milliradian 
to  10  microradians  in  angle  and  from  200  microradians  per 
second  to  2  microradians  per  second  in  angle  rate,  also  pro¬ 
viding  a  physically  reasonable  set  of  characteristics. 
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Figure  4-2.  Example  of  SOFEPL  Output 


*1.3  Figures  of  Merit 

When  comparing  the  performance  of  several  algorithms, 
the  criteria  used  to  determine  which  is  "best"  must  be  deters 
mined.  For  this  study,  the  problem  was  broken  down  into  two 
phases:  convergence  and  tracking.  A  dividing  time  of  *10 

seconds  into  the  run  was  used  to  separate  the  two  phases,  thus 
giving  the  algorithm  a  fair  amount  of  time  to  converge  before 
tracking  analysis  is  begun. 

The  following  figures  of  merit  are  proposed: 

1)  the  amount  of  time  needed  for  the  mean  error  to  con¬ 
verge  from  erroneous  initial  conditions  to  within 
105  of  the  true  range, 

2)  the  maximum  mean  error  in  range  and  the  maximum  magni 
tude  of  (mean  error  pluse  or  minus  one  standard 
deviation)  after  the  *40  second  convergence  time, 

3)  the  time  average  of  the  mean  error  and  the  time 
average  of  the  standard  deviation  of  the  mean  error, 
again  after  the  *10  second  convergence  time. 

The  time  to  converge  should  give  a  meaningful  measure  of 
acquisition  ability,  something  that  is  of  crucial  importance 
in  a  ranging  algorithm.  By  including  data  on  the  maximum 
mean  error  and  standard  deviation  as  well  as  the  time  average 
of  the  mean  error  and  standard  deviation,  we  can  portray  tc 
some  degree  how  much  the  errors  varied  from  one  simulation 


run  to  the  next  (time  averaged  standard  deviation)  as  well  as 
how  much  the  errors  varied  during  the  course  of  the  runs 
(maximum  values).  Said  another  way,  one  set  of  criteria  pre- 


sents  RMS  error  by  averaging  out  the  time  varying  variability, 
and  a  second  set  of  criteria  indicates  worst  deviations  from 
this  kind  of  performance. 

Because  the  Monte  Carlo  simulation  results  are  valid  only 
for  the  particular  target  and  fighter  trajectories  used  during 
any  one  set  of  runs,  the  algorithm  comparisons  must  likewise 
be  qualified  as  being  true  only  for  one  particular  engagement 
scenario . 
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CHAPTER  V 


RESULTS 

5.1  Introduction 

The  results  of  the  Monte  Carlo  simulation  of  the  six 
ranging  algorithms  are  discussed  in  this  chapter.  This  first 
section  explains  the  specific  fighter  and  target  maneuver 
profiles  which  were  evaluated  and  provides  some  insight  into 
why  these  profiles  were  chosen.  The  evaluation  results  are 
examined  in  the  subsequent  four  sections,  in  which  the  algori¬ 
thms  are  presented  generally  in  the  order  of  least  successful 
to  most  successful. 

5.2  Maneuver  Profiles 

5.2.1  Fighter  Profile.  The  maneuver  profile  flow  by  the 
fighter  air  raft  in  all  simulations  is  shown  in  Figure  5-1. 

It  is  made  up  of  a  sequence  of  flight  segments,  each  consisting 
of  a  fifty  degree  heading  change,  a  fifty  degree  heading  change 
in  the  opposite  direction  (back  to  the  original  heading),  and 
a  segment  of  level,  unaccelerated  flight.  The  turns  last  for 
ten  seconds  each,  while  the  straight  segment  lasts  for  thirty 
seconds.  The  fighter  altitude  is  25,000  feet,  its  total  velo¬ 
city  is  a  constant  1000  feet/second  (approximately  Mach  1), 
its  initial  heading  is  due  north,  and  all  turns  are  accomplished 
at  an  acceleration  of  3  g's,  where  1  g  «  32.2  feet/second/ 
second . 

The  altitude  and  velocity  of  the  fighter  were  chosen  as 
representative  of  the  altitude  and  velocity  at  which  an  in- 
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terceptor  aircraft  Is  likely  to  be  flying  in  an  air  defense 
type  scenario.  The  g  loading  used  in  the  turns  was  selected 
as  a  moderate  value  which  gives  a  reasonably  rapid  turn  rate 
to  enhance  observability  (as  discussed  in  the  following  para¬ 
graph),  while  still  providing  for  pilot  comfort. 

The  weave  type  maneuver  schedule  flown  by  the  fighter 
was  necessitated  by  an  observability  problem  which  is  inherent 
in  bearing-only  ranging  without  purposeful  direction  changing 
by  the  attacker  (4;11).  While  lack  of  observability  of  target 
range  has  not  been  mathematically  shown  for  three  dimensional 
aircraft  motion  in  the  same  detail  as  for  the  case  in  which 
all  motion  is  limited  to  a  single  plane,  the  observability 
enhancement  provided  by  figher  aircraft  maneuver  can  be  seen 
readily  in  the  simulation  results.  This  point  will  be  dis¬ 
cussed  further  in  subsequent  sections. 

5.2.2  Target  Profiles.  Thirteen  target  profiles  were 
used  in  the  evaluation  of  the  ranging  algorithms.  Profiles 
1  through  8  are  s imulat ions  of  non-maneuvering  targets,  in 
which  the  initial  target  heading,  range,  velocity,  and  alti¬ 
tude  are  varied  between  profiles.  Profiles  4 A ,  4b,  4c,  5A, 
and  5B  are  variants  of  profiles  4  and  5  in  which  the  target 
maneuvers  at  approximately  100  seconds  into  the  run.  A  sum¬ 
mary  of  the  target  maneuver  schedules  is  given  in  Table  5-1. 

In  all  cases,  the  target's  initial  position  is  due  north  of 
the  fighter  (on  the  fighter's  nose). 

From  Table  5-1  it  can  be  seen  that  the  general  trend  is 
for  target  airspeed  and  altitude  to  increase  as  the  initial 


range  increases.  The  reasoning  behind  this  is  that,  due  to 
sensor  limitations,  a  target  acquired  at  long  range  will 
more  likely  be  a  fast,  high-flying  aircraft,  while  one  ac¬ 
quired  at  a  shorter  range  is  more  likely  to  be  at  medium  alti¬ 
tude  and  airspeed. 

The  maneuvers  flown  in  profiles  4a,  4b,  5A,  and  5B  are 
5  g,  90  degree  turns.  The  turns  are  initiated  at  100  and 
120  seconds  into  the  run  in  order  to  evaluate  the  effect  of 
target  maneuvering  both  during  and  after  the  fighter's  observa¬ 
bility  maneuver,  which  occurs  between  100  and  120  seconds 
(see  Section  5.2.1).  The  maneuver  in  profile  4c  is  a  4  degree 
push  over  to  evaluate  the  algorithm's  sensitivity  to  an  alti¬ 
tude  change.  The  4  degree  descent  will  allow  the  target  to 
descend  from  50,000  feet  to  approximately  25,000  feet  during 
the  last  200  seconds  of  the  run. 

5.3  Evaluation  of  Algorithms  One  and  Two 

Algorithms  one  and  two  (see  Section  3-3.2  and  3- 3- 3)  were 
evaluated  against  target  profile  7,  where  the  algorithms  were 
given  perfect  Initial  conditions,  and  a  Q(t)  matrix  with 
diagonal  elements  indicative  of  a  target  model  with  a  3a 
acceleration  of  5  g's.  The  lo  values  used  for  the  angle  and 
angle  rate  measurement  errors  were  100  microradians  and  20 
microradians  per  second,  respectively.  The  diagonal  elements 
of  the  P(t  )  matrices  are  given  by  Table  P-1,  Appendix  P. 

The  above  evaluate  conditions  were  chosen  in  order  to 
evaluate  the  algorithms  under  a  scenario  favorable  to  algorithm 
performance.  Target  profile  7  is  a  non-maneuvering  profile 
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and  Is  initiated  at  a  long  enough  range  to  give  the  algorithm 
time  to  recover  from  any  initial  transients  (see  Table  5-1). 
The  Q(t)  matrix  is  representative  of  a  relatively  benign  tar¬ 
get,  which  is  accelerating  at  1.66  g's  or  less  68%  of  the 
time.  By  giving  the  algorithm  perfect  initial  conditions,  any 
problems  in  the  initial  convergence  caused  by  an  erroneous 
x(tQ)  are  avoided.  The  la  error  values  for  angle  measure¬ 
ments  (used  in  algorithm  two)  and  angle  rate  measurements 
(used  in  both  algorithms)  were  chosen  as  typical  of  what  one 
might  expect  of  a  future  sensor  system.  Finally,  the  error 

covariance  matrix  was  initialized  as  a  diagonal  matrix,  with 

2 

the  diagonal  terms  set  to  what  was  considered  reasonable  a 
values  for  the  states  they  represent,  in  the  case  where 
x(tQ)  was  not  known  a  priori. 

As  can  be  seen  from  the  plots  in  Appendices  G  and  H, 
both  algorithms  showed  significant  range  errors,  even  in  the 
favorable  cases  evaluated.  Although  Figure  G-l  indicates  that 
further  filter  tuning  may  have  improved  algorithm  one's  per¬ 
formance  to  some  extent,  the  basis  for  the  poor  performance 
of  both  algorithms  lies  in  the  observability  problem  discussed 
in  Section  5.2.1  as  it  relates  to  the  target  model.  The  Kal¬ 
man  filters  were  both  able  to  find  a  solution  which  met  all 
of  the  given  constraints,  so  that  the  residuals  were  in  fact 
approximately  zero  mean  with  the  appropriate  variances.  Due 
to  the  lack  of  observability  of  all  target  states  for  the 
given  target  model,  however,  the  algorithm  estimates  were 
both  severely  biased,  with  mean  errors  in  the  position  or 
range  states  considerably  larger  than  the  filter-computed 


standard  deviation.  In  other  words,  there  were  not  enough 
constraints  in  the  model  for  target  motion  given  to  the  fil¬ 
ter  to  allow  the  filter  to  converge  to  the  correct  answer. 


Referring  first  to  Appendix  H,  it  can  be  seen  that  al¬ 
gorithm  two  diverged  within  the  first  twenty  seconds  of  the 
run.  By  looking  at  the  output  of  a  single  run,  it  was  found 
that  the  velocity  in  the  north  direction  was  estimated  to  be 
a  very  large  negative  value.  Before  this  estimate  could  be 
corrected,  the  estimated  target  had  "flown  past"  the  fighter, 
producing  azimuth  residuals  on  the  order  of  i  x  10^  micro¬ 
radians,  i.e.,  it  radians,  and  resulting  in  divergence. 

Appendix  G  shows  that  algorithm  one  was  making  an  effort 
to  converge  to  the  correct  solution,  but  was  making  range 
errorsaveraging  approximately  45  nautical  miles  throughout 
the  run.  One  can  see  clearly  from  Figures  G-l  and  G-2  the 
effects  that  the  observability  enhancement  maneuvers  performed 
by  the  fighter  every  50  seconds  have  on  aiding  filter  conver¬ 
gence  and  decreasing  the  filter's  estimate  of  the  standard 
deviation  of  the  errors  In  its  state  vector  estimate. 

It  is  unclear  exactly  why  algorithm  two  diverged  so 
rapidly  while  algorithm  one  appears  to  be  at  least  making  an 
effort  to  track  the  target.  However,  because  neither  algo¬ 
rithm  appeared  to  be  performing  satisfactorily,  they  were  not 
investigated  further. 

5.4  Evaluation  of  Algorithm  Three 

Algorithm  three  (see  Section  3  •  3  •  *0  was  evaluated  against 
target  profile  7,  where  perfect  initial  conditions  were  again 


given  to  the  filter.  The  la  values  of  the  angle  and  angle 
rate  measurement  errors  were  set  at  100  microradians  and  20 
microradians  per  second.  The  diagonal  terms  of  Q(t)  were  set 

2  3  p 

to  1000  feet  /second  in  the  Vx  and  V  channels,  and  100  feet  / 

•3 

second  in  the  V  channel.  As  discussed  in  Section  3-4.4, 

z 

this  models  the  target  as  basically  non-maneuvering,  with 
less  velocity  change  in  the  z  direction  than  in  the  x  and  y 
directions.  (This  is  reasonable  from  the  viewpoint  of  the 
expected  maneuvers  of  an  actual  target,  which  should  be  mostly 
in  the  horizontal  plane,  and  also  helps  to  further  constrain 
the  target  model).  The  diagonal  element  of  P(t  )  are  given 
in  Table  P-1,  Appendix  P.  The  justification  of  these  choices 
is  to  provide  an  initial  evaluation  where  conditions  are  favor¬ 
able  for  good  algorithm  performance,  as  previously  discussed 
in  Section  5.3* 

This  algorithm  tracked  well  compared  to  algorithms  one 
and  two,  as  shown  by  the  plots  in  Appendix  I.  This  result 
was  to  be  expected,  since  the  target  motion  was  constrained 
in  algorithm  three  to  basically  unaccelerated  flight.  By 
further  constraining  the  target  model,  we  have  limited  the 
set  of  solutions  which  fit  both  the  dynamics  and  measurement 
equation,  thus  alleviating  to  some  extent  the  problem  of 
observability.  Again,  the  effects  of  fighter  maneuver  on 
filter  convergence  can  be  seen  easily,  particularly  in 
Figures  1-1  and  1-4. 

These  same  figures  also  show  clearly  another  problem 
which  appeared  in  algorithms  five  and  six  as  well.  Looking 
at  Figure  1-1,  we  see  that  a  transient  occurs  in  the  first 


three  updates  causing  a  mean  error  of  approximately  -400,000 
feet  at  3  seconds  into  the  run.  Because  the  error  is  plotted 
as  true  state  minus  filter  state,  this  -400,000  feet  means 
that  the  filter  is  over-estimating  the  x  position  by  this 
amount.  Before  the  transient  can  die  out,  however,  the  fil¬ 
ter-computed  error  covariance  collapses  to  a  very  small  value, 
thus  indicating  that  the  filter  "thinks"  that  its  estimate  is 
relatively  accurate.  Because  of  this,  the  filter  puts  little 
weight  on  the  measurements,  and  the  recovery  is  slow. 

Because  the  filter  thinks  its  estimate  of  position  in 
the  x  direction  is  good,  it  assumes  that  the  change  in  posi¬ 
tion  estimate,  which  is  really  due  to  the  convergence  of  the 
estimate  to  the  true  value,  is  caused  by  target  motion.  This 
Induces  a  large  error  in  the  velocity  estimate  in  the  x  direc¬ 
tion  (Figure  1-4),  because  the  filter  estimates  that  the  tar¬ 
get  is  coming  toward  the  fighter  much  faster  than  it  really 
is . 

A  solution  to  this  problem  would  be  to  force  the  filter- 
computed  covariances  to  remain  large  artificially  until  the 
transients  have  died  out.  Because  of  the  computational  burden 
caused  by  computing  bias  correction  terms,  the  fact  that  this 
algorithm  requires  azimuth  and  elevation  measurements  as  well 
as  rate  measurements,  and  the  promising  nature  of  algorithms 
five  and  six,  the  investigation  of  algorithm  three  was  stopped 
here  and  further  tuning  was  not  attempted. 


5.5  Evaluation  of  Algorithm  Four 


As  previously  mentioned  in  Section  3. 3. 5,  the  target 
model  used  in  algorithm  four  is  an  attempt  to  constrain  tar¬ 
get  motion  beyond  the  time-correlated  acceleration  models  of 
algorithms  one  and  two  but  not  to  the  point  of  completely  un¬ 
accelerated  flight  as  in  algorithms  three,  five,  and  six. 
Algorithm  four  was  evaluated  against  a  target  flying  profile 
7,  and  was  given  perfect  Initial  conditions,  with  P(t  )  as 
given  in  Table  P-1,  Appendix  P.  The  standard  deviations  of 
the  measurement  errors  were  set  as  in  the  previous  two  sec¬ 
tions.  Justification  of  these  conditions  is  given  in  Section 
5.3. 

Figures  J-l  through  J-*J  show  the  results  of  algorithm 

2 

four  when  using  a  Q(t)  whose  diagonal  terms  are  1000  feet  / 

3  7  2  3 

second  (for  the  v  channel)  and  2  x  10  y  radians  /second 

« 

(for  the  a  channel).  Physically,  these  input  data  tell  the 

filter  that  the  target  is  not  maneuvering  very  much  (the 

•  • 
strength  of  w(t)  in  the  a  channel  corresponding  to  a  la  a 

2 

change  of  0.3  degrees/second  ).  As  can  be  seen  from  these 

plots,  the  algorithm  did  well  in  tracking  the  non-maneuvering 

target  under  these  conditions. 

The  strength  of  the  a  channel  driving  noise  was  then 

increased  to  a  value  corresponding  to  a  la  heading  rate  change 

2 

of  3  degrees/second  ,  and  the  simulation  was  run  again  on 
profile  7,  this  time  for  only  100  seconds  so  that  the  time 
axis  could  be  expanded  horizontally  and  the  plot  read  more 
easily.  Figures  J-5  through  J-8  show  that,  even  when  using 
this  target  model  which  is  relatively  benign  compared  to  what 


might  be  expected  from  an  actual  target,  the  filter's  solu¬ 
tion,  while  fitting  the  dynamics  and  measurement  equation, 
was  not  the  true  solution  to  the  problem.  Note  the  dramatic 
increase  in  error  standard  deviation  in  Figure  J-7  at  50 
seconds,  caused  by  the  fighter  maneuver  at  that  time.  Again, 
because  this  algorithm  could  not  track  a  non-maneuvering  target 
when  using  a  target  model  which  assumed  even  a  small  amount  of 
maneuverability,  and  because  algorithms  five  and  six  looked 
promising,  this  algorithm  was  not  investigated  further. 

5.6  Evaluation  of  Algorithms  Five  and  Six 

5.6.1  Introduction.  Algorithms  five  and  six  (see  Sec¬ 
tion  3.3.6  and  3-3.7)  were  evaluated  fully  against  all  target 
profiles,  both  maneuvering  and  non-maneuvering.  This  section 
is  divided  into  subsections  which  take  the  reader  chronologi¬ 
cally  through  the  algorithm  development.  Filter  convergence 
enhancement,  algorithm  performance  against  maneuvering  and 
non-maneuvering  targets,  and  the  effects  of  varying  the 
strength  of  the  sensor  measurement  errors  are  discussed  in  the 
next  four  sections. 

The  values  used  for  the  strength  of  the  dynamics  driving 

noise  (the  diagonal  elements  of  Q(t))  in  the  V  ,  V  ,  and  V 

x  y  z 
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channels  were  1000  feet  /second  ,  1000  feet  /second",  and 

2  3 

100  feet  /second  ,  respectively,  throughout  the  evaluation. 

The  smaller  strength  in  the  V  channel,  as  before,  was  set 
both  in  order  to  represent  expected  real  world  target  motion 
best  and  because  it  was  thought  that  any  additional  constraint 
on  target  motion  would  aid  the  algorithm  performance,  given 
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that  the  simulated  target  met  that  constraint.  The  strength 

of  the  pseudonoise  introduced  into  the  range  channel  was 

varied,  as  discussed  in  the  following  section,  but  was  set 

to  ^  x  1011  feet'Vsecond  for  all  runs  after  initial  tuning. 

This  value  allowed  the  estimated  lo  of  the  range  error  from 

the  error  covariance  matrix  to  increase  to  approximately 
5 

5  x  10  feet  just  before  the  measurement  update,  thus 
assuring  the  most  rapid  recovery  from  errors  within  the  range 

5 

of  +  5  x  10  ,  as  discussed  in  the  following  section. 

The  standard  deviations  of  the  angle  and  angle  rate 
measurement  errors  were  set  to  100  microradians  and  20  micro¬ 
radians  per  second  for  all  runs  except  those  described  in  Sec¬ 
tion  5.6.5,  where  they  were  explicitly  varied  to  evaluate 
algorithm  sensitivity.  As  before,  these  numbers  represent 
the  errors  anticipated  of  a  future  sensor  system.  It  should 
be  noted  that,  as  explained  in  Section  3.3.6  and  3-3.7,  the 
angle  measurements  are  not  a  part  of  the  measurement  vector, 
but  are  input  to  the  filter  as  if  they  were  known  control 
inputs.  The  diagonal  elements  of  P(tQ)  are  given  in  Table 
P-1,  Appendix  P. 

5.6.2  Filter  Convergence  Enhancement.  One  of  the  first 
and  most  Important  problems  encountered  was  that  of  getting 
the  filter  to  converge  from  erroneous  initial  conditions. 

It  was  assumed  that  the  sensor  used  would  be  capable  of  ac¬ 
quiring  targets  out  to  ranges  approaching  200  nautical  miles. 
Since  no  a  priori  knowledge  of  target  range  is  possible  in  an 
actual  situation,  an  Initial  range  estimate  of  100  nautical 
miles  was  chosen  in  order  to  facilitate  acquisition  of  maxi- 
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mum  range  targets  as  well  as  short  range  "pop  up"  targets. 

Thus  filter  evaluation  against  target  profiles  1  through  8 
examines  convergence  from  a  -80  nautical  mile  to  +70  nautical 
mile  initial  error,  and  includes  (in  the  case  of  target  pro¬ 
file  4)  perfect  initial  conditions. 

The  problem  with  the  convergence  here  is  similar  to  that 
discussed  in  Section  5.4  in  reference  to  algorithm  three;  that 
is,  the  filter-generated  covariance  collapses  very  quickly, 
indicating  (falsely)  a  good  state  estimate.  Because  the  fil¬ 
ter  believes  that  it  has  a  very  good  estimate,  it  places  less 
weight  on  the  measurements,  thus  hindering  convergence,  and 
adversely  affecting  velocity  estimates  as  well. 

Figures  K-l  and  K-2  show  the  range  error  (0-40  seconds) 
and  the  x  velocity  error  (0-200  seconds)  of  algorithm  five 
when  run  against  target  profile  7.  In  this  case,  the  filter 
was  given  correct  initial  velocity  (so  that  the  effect  of 
initial  range  errors  could  be  seen  more  clearly),  but  an  ini¬ 
tial  range  which  was  80  nautical  miles  short  of  the  true  tar¬ 
get  range.  It  can  be  seen  that  the  filter-generated  covariance 
decreases  sharply  on  the  second  update,  while  the  mean  error 
converges  slowly  to  near  zero  at  40  seconds. 

The  proposed  solution  was  to  add  pseudonoise  to  the 

range  channel,  thus  preventing  the  filter  covariance  from 

converging  so  rapidly.  Figure  K-3  shows  that  same  profile 

11  2 

with  pseudonoise  of  strength  4  x  10  feet  /second  added. 

The  pseudonoise  was  added  for  the  first  20  seconds  in  order 
to  take  full  advantage  of  the  fighter  observability  enhance- 
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ment  maneuver,  which  occurs  during  those  20  seconds.  The 
mean  error  In  this  plot  is  approaching  zero  after  only  7  to 
10  seconds.  Additionally,  by  comparing  Figure  K-2  with 
Figure  K-4,  it  can  be  seen  that  the  velocity  bias,  which  was 
induced  by  the  range  errors  where  no  pseudonoise  was  added, 
has  been  greatly  reduced  by  the  addition  of  pseudonoise. 

It  should  be  noted  that  the  mean  error  curve  on  Figure 
K-3  is  relatively  smooth  and  the  standard  deviation  of  the 
errors  relatively  small  at  10  seconds  when  compared  to  the 
performance  both  before  and  after  this  time.  Also  note  that 
the  mean  error  plunges  to  a  negative  value  (indicating  an  over 
estimate  of  range)  at  18-20  seconds.  The  reason  behind  the 
apparent  recovery  and  subsequent  negative  drift  from  20-40 
seconds  is  not  known;  however,  the  explanation  of  filter 
behavior  at  18-20  seconds  has  an  impact  on  the  best  maneuvers 
for'  the  fighter  to  perform  and  is  at  the  crux  of  the  filter 
performance  evaluation. 

To  explain,  let  us  look  at  a  two  dimensional  problem, 
where  bearing  rate  is  simply  equal  to  the  relative  velocity 
perpendicular  to  the  line  of  sight,  divided  by  the  range,  or 


V  -F 
v  T  1  T 


where  9 


bearing  rate 


=  target  velocity  perpendicular  to  the  line  of  sight 
=  figher  velocity  perpendicular  to  the  line  of  sight 


range 
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In  the  filter  application,  however,  we  do  not  know  V, 


I#- 


T* 

but  only  the  filter's  estimate  of  VT>  which  can  be  written 
as  the  true  VT  plus  some  error,  e,p.  Substituting  into  Equa¬ 
tion  (48)  and  solving  for  the  range  estimate  R  gives 


R 


VT+eT-FT 

0 


(49) 


or 


R  = 


V  -F  p 

*  T  t  «f. 


(50) 


Thus  the  range  estimate  is  equal  to  the  true  range  plus 
eT 

an  error  term,  - — .  In  order  to  minimize  the  error,  we  have 
0 

eT 

to  minimize  -r— .  This  minimization  can  be  done  by  making  e_ 

6  1 

as  small  as  possible  while  making  e  as  large  as  possible. 

Looking  back  at  the  example  shown  in  Figure  K-3,  we  see 
that  the  plunge  in  mean  error  at  18-20  seconds  occurs  when 
the  fighter  is  headed  very  nearly  north  and  0  becomes  nearly 
zero.  The  errors  produced  by  an  erroneous  estimate  of  target 
velocity  cause  the  mean  error  to  jump,  while  errors  induced 
by  the  measurement  noise  cause  an  increase  in  the  standard 
deviation  of  the  errors.  The  fighter,  therefore,  in  order 
to  reduce  errors,  should  always  maneuver  to  obtain  maximum 
bearing  rate,  or,  in  other  words,  should  make  his  observa¬ 
bility  enhancement  turns  in  a  direction  away  from  any  per¬ 
ceived  line  of  sight  rate  caused  by  target  motion.  Also,  the 
pseudonoise  in  subsequent  runs  was  stopped  at  10  seconds 
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rather  than  20  in  order  to  minimize  the  effect  of  these 
errors  (both  measurement  errors  and  velocity  estimate  errors) 
on  the  range  estimate  by  allowing  an  earlier  collapse  of 
P(t)  in  the  position  channels. 

Initial  fighter  turns  into  and  away  from  the  line  of 
sight  rate  were  tested  against  target  profile  2;  the  turns 
away  from  the  line  of  sight  rate  greatly  improved  algorithm 
performance.  Because  In  an  actual  intercept  situation  the 
fighter  would  not  want  to  turn  away  from  the  target  any  more 
than  necessary,  (this  tactic  would  lengthen  the  time  to  com¬ 
plete  the  Intercept),  the  initial  fighter  maneuver  was  the 
only  one  In  which  the  fighter  turned  in  the  direction  that 
would  increase  azimuth  rate.  The  effect  of  reducing  the  time 
in  which  pseudonoise  is  added  to  10  seconds  can  be  seen  in 
the  plots  in  Appendices  L  and  M. 

So  far,  this  discussion  has  centered  on  making  0  as 
large  as  possible;  in  order  to  minimize  the  error  term  in 
Equation  (50),  however,  e^  must  also  be  reduced  to  its 
smallest  value.  The  ability  of  the  filter  to  reduce  the  size 
of  e,p  is  a  function  of  target  heading  with  respect  to  the 
fighter.  If  the  target  is  heading  directly  at  the  fighter, 
the  filter  can cfetermlne  that  the  target  velocity  perpendicular 
to  the  line  of  sight  is  near  zero,  and  e^  is  relatively  small. 
If,  on  the  other  hand,  the  target  has  a  large  component  of 
velocity  perpendicular  to  the  line  of  sight,  this  perpendicular 
velocity  is  more  a  function  of  the  filter's  estimate  of  tar¬ 
get  range,  and  is  more  difficult  to  estimate  accurately.  Thus 


a  target  flying  directly  across  the  line  of  sight,  while 
increasing  0,  is  at  the  same  time  and  by  a  proportionally 


larger  amount  increasing  e^,  and  decreasing  the  accuracy  of 
the  filter  estimate.  This  point  will  be  discussed  further, 
and  results  shown,  in  the  following  section. 

5.6.3  Algorithm  Performance  Against  Non-Maneuvering 
Targets .  Both  algorithms  were  tested  against  targets  flying 
the  non-maneuvering  profiles,  1-8.  In  all  cases,  the  algo¬ 
rithms  were  given  initial  conditions  of  100  nautical  mile  range 
and  2000  feet/second  velocity  due  south.  This  range  and 
velocity  approximate  the  mean  of  the  anticipated  target  range 
and  velocity  at  acquisition,  and  are  thus  the  best  values  for 
x(tQ),  given  no  a  priori  knowledge  of  target  state.  It  was 
assumed  that  the  target  would  be  acquired  as  it  came  into 
range,  and  would  thus  have  a  closing  velocity  with  respect 
to  the  fighter;  this  premise  led  to  the  selection  of  an  ini¬ 
tial  velocity  due  south,  or  directly  toward  the  fighter  air¬ 
craft  . 

The  results  are  given  in  Appendices  L  and  M,  and  in 
Tables  5-2  and  5-3.  The  appendices  are  arranged  such  that 
Figure  L-i  is  the  algorithm  five  plot  of  the  same  state  and 

target  profile  as  the  algorithm  six  plot  in  Figure  M-i.  Thus 

TH 

the  1  plots  in  Doth  appendices  can  be  compared  directly. 

(The  reader  is  cautioned  that  the  scale  on  the  ordinate  axis 
may  differ  between  Appendix  L  and  Appendix  M.)  The  simula¬ 
tions  were  run  for  different  lengths  of  time  for  the  different 
target  profiles,  ranging  from  80  seconds  for  profiles  1-?  to 
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180  seconds  for  profiles  4-6  to  280  seconds  for  profiles 
7-8.  In  order  to  Improve  the  legibility  of  the  plots,  the 
range  error  versus  time  plots  for  target  profiles  4-8  were 
broken  into  two  parts:  0-40  seconds,  and  40  seconds  to  the 
end  of  the  run.  This  expanded  the  figure  along  the  time 
axis  in  the  0-40  second  plot,  and  along  the  ordinate  axis  on 
the  40  second  to  end  of  run  plot,  making  both  easier  to  read. 

Tables  5-2  and  5-3  show  the  maximum  mean  error  (positive 
or  negative),  the  maximum  magnitude  of  the  mean  error  plus 
or  minus  one  standard  deviation  (i.e.,  the  negative  mean  error 
minus  one  standard  deviation  or  the  positive  mean  errors  plus 
one  standard  deviation,  v.'hichever  has  the  greatest  magnitude), 
and  the  time  averages  of  the  mean  error  and  the  standard 
deviation.  These  statistics  are  computed  from  time  =  40 
seconds  to  the  end  time  of  the  run,  allowing  40  seconds  for 
filter  convergence,  and  thus  represent  tracking  statistics. 
Additionally,  the  approximate  convergence  time  of  the  mean 
error  to  within  1Q%  of  the  true  range  is  entered  in  the  tables 
Because  this  convergence  time  is  read  from  the  plots,  it  is 
only  given  to  the  nearest  five  seconds. 

With  one  minor  exception,  the  performance  of  the  two 
algorithms  in  general  was  very  similar.  Both  performed  well, 
both  in  Initial  convergence  and  in  tracking,  against  the 
targets  either  coming  due  south  or  going  due  north  (profiles 
1,  3,  4,  6,  and  7;  see  Table  5-1  of  Section  5.2.2).  As 
stated  before,  the  filter  initial  conditions  assumed  a  range 
of  100  nautical  miles  and  a  velocity  of  2000  feet/second  due 


south.  This  good  observed  performance  is  due  to  the  fact 
that  the  target  velocity  perpendicular  to  the  line  of  sight  is 
near  zero,  and  the  filter  is  able  to  minimize  eT  well,  as  dis¬ 
cussed  in  Section  5-6.2  (See  Figure  L-l  through  L-3,  L-7 
through  L-13,  L-l8  through  L-25,  and  the  corresponding  figures 
in  Appendix  M.)  For  profiles  2,  5,  and  8,  target  velocity 
perpendicular  to  the  line  of  sight  is  not  essentially  zero, 
in  contrast.  Against  target  profile  5,  in  which  the  initial 
condition  happened  to  be  the  correct  target  range,  v/e  also  see 
rapid  convergence.  The  filter  is  able,  because  of  the  cor¬ 
rect  initial  range,  to  find  the  proper  velocity  on  the  first 
measurement  update  (see  Figures  L-16  and  M-16).  However,  when 
evaluated  against  profiles  2  and  8,  where  an  erroneous  initial 
range  led  to  an  erroneous  velocity  estimate  (Figures  L-^ 
through  L-6,  L-26  through  L-29,  and  corresponding  Appendix  M 
plots),  the  filters  are  extremely  slow  in  converging.  The 
effect  of  fighter  maneuver  on  algorithm  convergence  can  be 
seen  clearly  in  Figure  L-6,  and,  to  a  lesser  degree  in  Fig¬ 
ures  L-4  and  L-5-  The  fighter  was  maneuvering  from  50  to  70 
seconds  into  the  run,  causing  a  dramatic  recovery  in  the  V 
channel.  The  errors  induced  in  the  channel,  as  previously 
discussed,  are  caused  by  the  increase  in  filter  range  esti¬ 
mate  as  it  converges  toward  the  true  range.  Eecause  the  fil¬ 
ter-generated  error  covariance  in  the  range  channel  is  small, 
the  filter  "thinks"  that  its  range  estimate  has  been  accurate 
since  10  seconds  into  the  run,  and  it  interprets  the  range 
estimate  change  as  target  motion. 


77 


4 


A  general  trend  encountered  in  both  algorithms  is  the 
constant  negative  drift  of  range  and  x  velocity  estimate 
during  the  time  when  the  fighter  is  not  maneuvering  (Figures 
L-15,  L-19,  L-23  and  L-24  provide  good  examples).  The  drift 
seems  in  most  cases  to  be  worse  at  longer  range.  The  cause 
of  this  drift  is  not  known;  it  is  assumed  that  the  drift  was 
caused  by  linearizing  the  measurement  equation. 

An  example  of  the  difference  between  the  two  algorithms 
can  be  seen  by  comparing  Figure  L-ll  with  Figure  M-ll.  Be¬ 
cause  algorithm  six  assumes  that  target  velocity  is  (essen¬ 
tially)  constant  in  the  LOS  frame,  the  rotation  of  the  LOS 
frame  with  respect  to  the  earth  biases  the  algorithm  output. 
This  effect  is  most  apparent  toward  the  end  of  the  run,  be¬ 
cause  the  target  is  getting  closer  to  the  fighter  and  the 
LOS  frame  is  rotating  faster.  This  bias  also  affects  conver¬ 
gence  to  a  small  degree,  since,  as  discussed  earlier,  the 
best  fighter  maneuver  with  regard  to  convergence  is  that 
which  gives  the  highest  angle  rates,  thus  providing  the  worst 
case  for  the  algorithm  six  target  motion  assumptions  (see 
Figures  L-10  and  M-10). 

When  these  algorithms  were  first  tested,  both  algorithms 
diverged  when  run  against  target  profile  1  (target  headed  due 
south  from  30  nautical  mile  initial  range),  and  algorithm 
five  liverged  when  run  against  target  profile  6  (target 
headed  due  north  from  100  nautical  mile  initial  range).  By 
examir ing  the  output  of  a  single  run  of  the  Monte  Carlo  simu¬ 
lation,  it  was  noted  that  the  range  estimate  in  the  state 
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vector  went  negative  during  the  Initial  transient  in  filter 
acquisition.  Because  the  filter  equations  are  all  based  on 
a  positive  range,  the  algorithm  could  not  recover  from  a  nega¬ 
tive  range  estimate. 

In  order  to  correct  this  problem,  an  artificial  lower 
bound  was  placed  on  the  range  estimate,  so  that  if  the  range 
estimate  ever  went  below  zero,  it  was  reset  to  100,000  feet. 
The  value  of  100,000  feet  was  chosen  as  relatively  short 
range  (about  16.5  nautical  miles)  from  which  the  filter  could 
converge  to  the  true  range  with  a  less  violent  transient  re¬ 
sponse.  V/hile  both  algorithms  were  run  again  against  target 
profile  6,  apparently  only  algorithm  five  required  the  arti¬ 
ficial  lower  bound,  as  there  was  no  change  in  the  algorithm 
six  plots.  In  the  case  of  algorithm  five,  Figure  L-l8  shows 
that  after  the  second  update,  the  mean  of  the  error  is  approx! 
mately  +500,000  feet,  indicating  a  range  estimate  of  ICO, GOO 
feet,  with  zero  standard  deviation.  This  is  the  result  of 
resetting  the  range  estimate  (zero  standard  deviation  implies 
that  it  was  reset  on  all  Monte  Carlo  simulation  runs),  and 
explains  the  difference  between  the  performance  of  the  two 
algorithms  against  target  profile  6. 

5.6.4  Algorithm  Performance  Against  Maneuvering  Targets. 
For  the  following  reasons,  only  algorithm  five  was  tested 
against  target  maneuvers: 

1.  algorithms  five  and  six  performed  similarly  against 
non-maneuvering  targets 

2.  the  difference  between  the  dynamics  and  measurement 
equations  of  the  two  algorithms  leads  one  to  anti¬ 
cipate  similar  performance  against  all  target  profile 
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3.  an  analysis  of  algorithm  six  against  target  profile 
4A  produced  results  similar  to  those  of  algorithm 
five  against  the  same  target  profile 

In  addition  to  target  profiles  4a,  4b,  4c,  5A,  and  5B 
described  in  Section  5.2.2,  algorithm  five  was  also  evaluated 
against  a  target  which  maintained  a  collision  course  with  the 
fighter.  Appendix  N  shows  the  results  of  these  simulations. 

Figure  N-l  through  N-3  show  the  results  of  a  target 
maintaining  collision  course  throughout  the  initial  fighter 
maneuver.  It  was  expected  that  having  an  essentially  zero 
bearing  rate  throughout  the  maneuver  would  cause  the  algorithm 
to  do  poorly  in  estimating  range,  and  that,  due  to  the  in¬ 
creased  gain  in  the  first  10  seconds,  this  anticipated  effect 
would  be  most  apparent  during  the  initial  maneuver.  The 
filter,  however,  tracked  the  changing  target  velocities  well 
enough  to  keep  the  range  at  approximately  its  initial  value. 
Thus  the  filter,  lacking  other  information,  assumes  that  the 
initial  range  is  correct  and  changes  Its  estimate  of  target 
velocity  to  fit  the  received  measurement  data  (the  observa¬ 
bility  problem  again  being  manifested).  The  cause  of  the 
rapid  drift  from  20  to  30  seconds  seen  in  all  three  plots 
could  not  be  determined. 

Figures  N-4  through  N-7  and  N-8  through  N-ll  show 
filter  performance  against  target  profiles  4  A  and  4b  ,  in  which 
the  target  is  flying  south  and  makes  a  hard  left  turn  to  east 
at  t=100  seconds  (profile  4a  )  or  t=120  seconds  (profile  4b). 
Because  the  algorithm  is  getting  much  of  its  information 
during  the  fighter  maneuver,  it  was  anticipated  that  a  target 
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maneuver  during  this  time  (from  t=100  to  t=120)  would  cause 
a  larger  error  than  one  initiated  after  the  fighter  maneuver 
was  complete.  The  time  of  the  target  maneuver  does  make  a 
slight  difference,  but  the  algorithm  performance  in  both 
cases  shows  the  same  trend.  As  seen  previously,  and  discussed 
fully  in  Section  5.6.2,  the  filter  solves  for  a  range/velocity 
combination  which  fits  the  measurement  data,  but  when  the  tar¬ 
get  is  moving  basically  perpendicular  co  the  line  of  sight, 
it  is  difficult  to  determine  the  correct  range/velocity  com¬ 
bination.  Thus  the  error  in  velocity  ( e^  in  Section  5.6.2) 
remains  large,  and  the  range  estimate  remains  in  error  by 
almost  30  nautical  miles,  converging  only  very  slowly.  This 
error  appears  as  a  bias  after  t=100  seconds  in  Figures  N-5, 
N-7,  N— 9 >  and  N-ll.  Note  that  the  recovery  of  the  x  velocity 
in  Figures  N-6  and  N-10  only  indicates  that  the  range  error 
(which  is  still  mostly  in  the  north-south  direction)  has  sta¬ 
bilized,  not  that  it  has  recovered.  If  one  more  observability 
enhancement  maneuver  were  performed,  one  would  expect  the 
errors  in  the  range  and  channels  to  be  decreased,  and  the 
error  in  the  channel  to  increase  in  the  negative  direction 
as  it  again  misinterprets  the  range  estimate  change  as  target 


mot  ion . 

An  examination  of  Figures  N-12  through  N-15  and  h-16 
through  N-19  shews  that,  as  expected  (from  the  Immediately 
preceeding  discussion  and.  Section  5-6.2),  the  filter  converges 
to  the  correct  range  much  faster  when  the  target  turns  south 
(target  profiles  5A  and  5B),  thus  reducing  its  velocity  com¬ 


ponent  perpendicular  to  the  line  of  sight.  There  is,  in  this 
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case,  a  significant  difference  between  plots  where  the  tar¬ 
get  maneuvered  at  100  seconds  (during  attacking  fighter  maneu¬ 
vers),  and  those  where  the  target  maneuvered  at  120  seconds 
(after  the  fighter  maneuver).  In  comparing  Figures  N-14  and 
N-15  against  N-l8  and  N-19,  it  can  be  seen  that  the  error  in 
the  velocity  estimates  is  less  when  the  target  maneuvered 
after  the  fighter  maneuver  was  complete.  It  is  not  clear  why 
the  range  estimates  in  Figures  N-13  and  N-17  were  in  error 
in  opposite  directions;  however,  it  is  apparent  that  the  fil¬ 
ter  was  less  in  error  and  converged  more  quickly  when  evalu¬ 
ated  against  target  profile  5B. 

Finally,  Figures  N-20  through  N-2^  show  filter  perfor¬ 
mance  against  a  target  that  begins  a  shallow  descent  at  t=100 
seconds  (target  profile  4c).  While  filter  convergence  dees 
not  appear  to  be  a  problem,  it  is  somewhat  surprising  that  a 
4  degree  target  pitch  change  can  cause  a  change  of  approximate¬ 
ly  60,000  feet  In  the  range  estimate.  The  range  estimate  did, 
however,  recover  well  from  this  error  (see  Figure  N-21). 

This  maneuver  was  not  evaluated  when  initiated  at  a  time 
other  than  during  the  fighter  maneuver;  however,  it  is  assumed 
that,  as  in  horizontal  target  maneuvers,  filter  performance 
would  be  degraded  less  if  the  target  maneuver  occurred  while 
the  fighter  was  flying  straight  and  level. 

5.6.5  Effects  of  Varying  Measurement  Errors.  Lastly, 
runs  were  made  in  which  the  la  values  for  the  angle  and  angle 
rate  measurements  were  varied  up  and  down  by  an  order  of  mag¬ 
nitude  from  the  100  microradians  and  20  microradians/second 


used  In  previous  evaluations.  As  explained  in  Sections  3.3.6 
and  3*3.7,  the  angle  measurements  are  not  a  part  of  the  mea¬ 
surement  vector,  but  are  considered  as  a  known  control  input 
in  order  to  reduce  the  computational  load.  The  filter  RCt^) 
matrix  was  changed  corresponding  to  the  change  in  the  errors 
being  fed  into  the  filter,  so  that  the  algorithm  always  "knew" 
the  true  variance  of  the  measurement  errors.  (While  robust¬ 
ness  to  unmodelled  changes  in  the  real  world  was  not  investi¬ 
gated,  it  easily  could  be  in  the  future.)  The  results  of 
these  runs  are  given  in  Figures  0-1  through  0-l6  (for  target 
profile  5,  with  the  target  initially  at  100  nautical  miles 
headed  east)  and  Figures  0-17  through  0-32  (for  target  profile 
7,  with  the  target  initially  at  180  nautical  miles  headed 
south)  of  Appendix  0,  and  in  Tables  5-4  and  5-5  to  follow. 

tv 

The  plots  in  Appendix  0  can  be  compared  to  runs  made  previously 
against  the  same  target  profiles  (again,  5  and  7)  using  the 
nominal  measurement  error  strengths,  the  results  of  which  are 
given  in  Figures  L-l4  through  L-17  and  L-22  through  L-25. 

The  results  of  varying  the  la  values  of  the  bearing  rate 
measurements,  given  in  Figure  0-1  through  0-8  and  0-17  through 
0-24,  are  exactly  as  anticipated.  Lowering  the  standard  de¬ 
viation  to  2 vj  rad/sec  improves  performance  both  by  decreasing 
the  standard  deviation  of  the  errors  in  the  filter  estimates 
and  by  decreasing  the  mean  error.  Increasing  the  lo  error 
value  has  the  opposite  effect.  One  can  also  see  that  the 
filter  generated  covariance  changes  in  the  same  manner  as  the 
true  error  variance,  thus  indicating  that  the  filter  is  aware 


83 


that  its  state  estimates  will  be  less  accurate  if  given  less 
accurate  measurements. 

Since  the  angle  measurements  are  brought  into  the  algorithm 
without  being  filtered,  the  results  of  varying  the  errors  in 
angle  measurements  was  somewhat  less  predictable,  although 
one  would  still  expect  that  a  larger  error  variance  would 
lead  to  a  larger  error  in  the  algorithm's  estimate.  In  com¬ 
paring  Figures  0-9  through  0-12  with  L-l4  through  L-17,  and 
0-25  through  0-28  with  L-22  through  L-25,  it  can  be  seen  that 
the  difference  is  so  small  as  to  be  virtually  undetectable. 

An  increase  in  the  la  error  standard  deviation  to  1  milliradian 
causes  a  significant  Increase  both  in  the  mean  and  the  vari¬ 
ance  of  the  errors  in  the  estimates.  Note  that  the  filter 
generated  covariance  does  not  change  appreciably  in  this  case. 


CHAPTER  VI 

CONCLUSIONS  AND  RECOMMENDATIONS 

6.1  Conclusion 

Of  the  six  algorithms  examined,  only  those  using  non¬ 
accelerating  target  models  were  able  to  track  a  non-maneuvering 
target  successfully.  This  is  as  expected,  and  due  for  the 
most  part  to  the  observability  problem  in  finding  target  range 
from  bearing  and  bearing  rate  measurements.  If  the  target 
model  in  the  filter  is  that  of  a  maneuvering  aircraft,  the 
filter  is  unable  to  select  the  correct  solution  for  the  target 
states  out  of  the  infinitely  large  set  of  solutions  which  solve 
the  dynamics  and  measurement  equations. 

The  two  algorithms  that  were  fully  evaluated  against  non¬ 
maneuvering  targets  performed  simil  rly  against  these  target 
profiles.  In  cases  in  which  the  target  was  flying  either 
directly  toward  or  directly  away  from  the  fighter,  both  algo¬ 
rithms  converged  quickly  and  tracked  well.  In  cases  in  which 
the  target  was  moving  perpendicular  to  the  line  of  sight,  both 
algorithms  experienced  difficulty  in  converging  from  erroneous 
initial  conditions. 

Algorithm  five,  the  only  algorithm  evaluated  against 
maneuvering  targets  and  with  varying  measurement  error  strengths, 
performed  as  expected  in  all  cases.  When  the  target  maneuvered 
to  decrease  its  velocity  component  perpendicular  to  the  line 
of  sight,  or  turned  into  the  fighter,  the  algorithm  was  quick 
in  determining  the  new  target  state.  When  the  target  maneuver 
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increased  the  target  velocity  across  the  line  of  sight,  how¬ 
ever,  the  filter  experienced  difficulty  in  recovering  to  the 
true  target  state.  (As  explained  in  Section  5.6.2,  however, 
if  the  attacker  maneuvers  so  as  to  increase  0  in  Equation  (50) 
without  the  corresponding  increase  in  e^,  seen  when  the  target 
causes  0  to  increase,  range  estimation  improves.)  Varying 
the  angle  rate  measurement  error  standard  deviation  caused  a 
corresponding  variation  in  the  standard  deviation  of  the  errors 
in  the  filter's  estimates.  While  decreasing  the  standard  de¬ 
viation  of  the  angle  measurement  errors  had  little  effect,  in¬ 
creasing  this  standard  deviation  caused  an  increase  in  both 
the  mean  and  the  variance  of  the  errors  in  the  filter's  esti¬ 
mate. 

6.2  Recommendations 

Algorithms  five  and  six  should  be  further  evaluated  against 
other  target  profiles  to  determine  their  effectiveness  against 
targets  having  intermediate  heading  ■  rossing  angles.  These 
target  profiles  should  reflect  both  realistic  scenarios,  and 
geometries  and  trajectories  that  are  particularly  hard  or  easy 
for  the  filter  to  handle. 

The  robustness  of  algorithms  five  and  six  to  mismodelling 
measurement  errors  should  be  tested.  These  tests  should  in¬ 
clude  cases  in  which  the  assumed  error  variances  in  R ( t ^ )  are 
greater  than  and  less  than  the  variances  of  the  error  in  the 
measurements  actually  given  to  the  filter. 

The  possibility  of  developing  a  multiple  model  filter 
(6:129-136)  using  variations  of  algorithm  four  should  be  in- 
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vestigated.  If  heading  rate  is  Input  as  a  parameter,  it  may 
be  possible  to  track  a  maneuvering  target  using  several  simpli¬ 
fied  filters  running  in  parallel,  each  assuming  a  different 
heading  rate. 

The  Bayesian  filtering  approach  discussed  by  H.  W.  Sorenson 
in  Reference  12  should  also  be  investigated.  This  approach 
was  examined  briefly  in  the  course  of  this  thesis,  but,  due 
to  time  constraints,  was  not  pursued  fully.  Appendix  Q  gives 
a  brief  discussion  of  these  efforts. 
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ADDITIONAL  MATRICES  FOR  ALGORITHM  ONE 


This  appendix  gives  the  additional  matrices  needed  to 
implement  algorithm  one,  in  which  the  state  vector  is 
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The  F  [t;  x(t/t^)]  matrix  is  of  dimension  7x7.  It's 
non-zero  elements  are  as  follows: 


(A-3J 
(A- 31 
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APPENDIX  B 

ADDITIONAL  MATRICES  FOR  ALGORITHM  TWO 


This  appendix  contains  the  additional  matrices  needed 
to  implement  algorithm  two,  in  which  the  state  vector  is 

r  RET,  REL  REL  REL  REL  REL  1  I  I  ,T 
la  i.  vXT  vyT  vzT  XT  YT  ZTJ  : 
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( B-2 ) 


Because  the  H[t^;  _x ( t ^  )]  matrix  can  be  more  easily 

written  using  terms  defined  in  the  computation  of  the  bias 

correction  terms,  the  bias  correction  terms,  and 

b  „(t  will  be  described  next.  The  two  matrices  in  Equa- 

m2  i  ’ 
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tion  (35)  which  have  not  yet  been  specified  will  be  desig- 
1  2 

nated  H  and  H  ,  where 


trl  32h1Cx(t1~)J  u(ti).  t1] 

H  4  - 5 - 

3x 


(B-3) 


2  3  h2[x(t1"),  u(t1),  t i 3 
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3x 
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Additionally,  in  an  effort  to  reduce  the  complexity  of 
the  equations  in  this  appendix,  and  R2  will  be  defined  as 
follows : 


R,  A  ^L-+yREL- 


(B-5) 


r2  £ 
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(B-6) 


1  2 

The  H  and  H  matrices  are  dimension  9x9,  the  non-zero 
elements  of  which  follow.  The  elements  of  the  state  vector 
are  evaluated  at  time  t^~. 


,1  2XREL  YREL  x  106 


-2XREL  YREL  x  106 


(B-7a) 
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H[t^;  x(t1  )]  is  a  4x9  matrix,  the  non-zero  terms  of 

which  are  given  below.  Again  in  order  to  keep  the  complexity 

and  length  of  these  equations  to  a  minimum,  the  elements  of 

H [ t ^ ;  x(t  -)]  will  be  expressed  in  terms  of  the  elements  of 
1  2 

H  and  H  where  possible.  The  elements  of  the  state  vector 
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APPENDIX  C 

ADDITIONAL  MATRICES  FOR  ALGORITHM  THREE- 

This  appendix  contains  additional  matrices  needed  to 
implement  algorithm  three,  in  which  the  state  vector  is 


1  2 

The  H  and  H  matrices  defined  for  algorithm  three  in 


Appendix  E  are  the  same  for  algorithm  three,  except  that  they 
are  now  6x6  rather  than  9x9-  Similarly,  the  H  [t  ^  ;  x  ( t ..  -  )  ] 
matrix  for  algorithm  three  is  a  *1x6  matrix  with  the  same 
non-zero  elements  as  the  H^t^jx/t^  )]  matrix  for  algorithm 
two  described  in  the  previous  appendix,  where  the  target 
velocities  in  the  relative  NED  frame  are  defined  by  Equations 
(37a)  -  (37c),  Section  3-3.3. 
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ADDITIONAL  MATRICES  FOR  ALGORITHM  FOUR 


This  appendix  contains  additional  matrices  needed  to 
implement  algorithm  four,  in  which  the  state  vector  is 


[RS  V  ct  a]T: 
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1  0 
0  0 
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( D-l ) 


The  non-zero  terms  of  the  4x4  F[t;x(t/ti)]  matrix  are 


F11  =  VcosU  +  (6-a)xlO~6)sin(YXlO~6+RS/Re)xi  (D-2a) 


F12  =  -cos(ir+(e-a)xlO  6)cos(yXlO“6+RS/Re) 


(D-2b) 


F^^  =  -Vcos(YXlO~^+RS/Re)sin(u+(0-a)xlO  ^)xlO  ^  (D-2c) 


F34  -  1 


( D-2d ) 


where  RgA  radius  of  the  earth  =  20,891,000  ft. 

A 

The  non-zero  elements  of  the  2x4  H[ti;x(ti~)]  matrix 


H1,=(-Vsin(TT+(9-a)xl0'5)-V.L°S)  - 5 - - - 

R  cos  (  yxIO  d+R^/Rv) 


sln(YX]Q~6+RS/Re) 


RSRecos2( YXl0“°+RS/Re) 


x  10 


(D-ja) 
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APPENDIX  E 


ADDITIONAL  MATRICES  FOR  ALGORITHM  FIVE 


This  appendix  gives  the  additional  matrices  required  to 
implement  algorithm  five,  in  which  the  state  vector  is 


[rS  v*  V1 
Ln  VXT  YT  ZTJ  ' 


G(t)  = 


(E-l ) 


The  non-zero  terms  of  FC^xCt/t.^)]  are 


F12  =  cos( 9x10~^)cos(yx10_^) 
F^  =  sln(0xlO-^)cos(YxlO-^) 


(E-2a) 


(E-2b ) 


F,,.  =  sin(  yxlO  ) 


(E-2c ) 


The  non-zero  elements  of  H[ti;x(ti  )]  are 

V^Tcos(exlO-6)-V^Tsin(exlO"6)-VYp3 

2_  =  ‘  2 

R3  cos(yx10-^) 


x  10 


(E-3a) 


-sin( 8xl0~^ ) 
R3cos ( yx10-& ) 


(E-3b) 
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All  other  matrices  given  here  remain  the  same. 


APPENDIX  F 


ADDITIONAL  MATRICES  FOR  ALGORITHM  SIX 


This  appendix  contains  the  additional  matrices  needed 
to  Implement  algorithm  six,  in  which  the  state  vector  is 


rRS  vLOS  „LOS  vLOS-,T. 
LR  VXT  VyT  VZT  J  , 


G(t)  = 


(F-l) 


There  is  only  one  non-zero  value  in  F[t  ;x( t/t , ) ] ,  given 


P12  =  1 


(F-2) 


The  non-zero  elements  of  HCtijxCtj^")  ]  are 


-(v£°S-Vy°S)xl06 

— 

R  cos(yxlO  / 


(F-3a) 


13  RS 


(F-3b) 


( yLOS  yL0S ) xio^ 

' VZT  ZF  ; 


(F-3c) 


2'  ~  RS 


(F-3d) 
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Figure  G-l.  Algorithm  1,  Range  Error  Versus  Time 
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Figure  G-3.  Algorithm  1,  Azimuth  Rate  Error  Versus  Time 
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Figure  G-4.  Algorithm  1,  Evaluation  Rate  Error  Versus  Time 


Lgure  H-l .  Algorithm  2,  Position  Error  in  the  X  Directi 


Figure  H-2.  Algorithm  2,  Position  Error  in  the  Y  Direction  Versus  Time 


Fi cure  H-3.  Algorithm  2,  Position  Error  in  the  Z  Direction  Versus  Time 


Figure  H-M .  Algorithm  2,  Velocity  Error  in  the  X  Direction  Versus  Time 


Figure  H-5.  Algorithm  2,  Velocity  Error  in  the  Y  Direction  Versus  Time 


Figure  H-6.  Algorithm  2,  Velocity  Error  in  the  Z  Direction  Versus  Time 


Figure  H-7.  Algorithm  2,  Acceleration  Error  in  the  X  Direction  Versus  Time 


Figure  H-8.  Algorithm  2,  Acceleration  Error  in  the  Y  Direction  Versus  Time 


o 


Figure  H-9.  Algorithm  2,  Accel erat ion  Error  in  the  Z  Direction  Versus  Time 
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igure  1-1.  Algorithm  3,  Position  Error  in  the  X  Direction  Versus  Time 
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Algorithm  3,  Position  Error  in  the  Y  Direction  Versus  Time 


Figure  1-3-  Algorithm  3,  Position  Error  in  the  Z  Direction  Versus  Time 


Figure  1-^.  Algorithm  3,  Velocity  Error  in  the  X  Direction  Versus  Time 


Figure  1-5.  Algorithm  3,  Velocity  Error  in  the  Y  Direction  Versus  Time 


Figure  1-6.  Algorithm  3,  Velocity  Error  in  the  Z  Direction  Versus  Time 
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Figure  J-l.  Algorithm  4,  Range  Error  Versus  Time,  Non-Maneuvering 
Target  Model 


Figure  J-2.  Algorithm  A,  Total  Velocity  Error  Versus  Time,  Non-Maneuvering 
Target  Model 


Figure  J-3 •  Algorithm  4,  Heading  Error  Versus  Time,  Non-Maneuvering 
Target  Model 


Heading  Rate  Error  Versus  Time,  Non-Maneuvering 


Figure  J-5.  Algorithm  4 ,  Range  Error  Versus  Time,  Maneuvering  Target  Model 


Algorithm  ^ ,  Heading  Error  Versus  Time,  Maneuvering  Target 
Model 
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GRAPHICAL  RESULTS  OF  ADDING  PSEUDONOISE  TO 
THE  RANGE  CHANNEL  OF  ALGORITHM  FIVE 
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Algorithm  5,  Range  Error  Versus  Time,  No  Pseudonoise  in 
Range  Channel 


Algorithm  5,  Velocity  Error  in  the  X  Direc 


Algorithm  5,  Range  Error  Versus  Time,  Pseudonoise  in  the 
Range  Channel  for  the  First  20  Seconds 


Velocity  Error  in  the  X 
n  the  Range  Channel  for 
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—  f’<re  I.-l.  Alrc-rj  thr:  r>,  P  nnrr  :  r  .-c"--  "ersus  Time,  Target  Frofij 


Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  1 


ir;urc  L-3.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 


Figure  L-2A.  Algorithm  5,  Velocity  Error  in  the  Z  Direction  Versus  Time 
Target  Prc file  1 


ir;ure  L-A.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


Figure  L-5.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  2 


Figure  L-7.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


Figure  L-8.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  3 


Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Prof ile  3 
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Figure  L-ll.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
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Figure  L-13.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  4 


Figure  L-l4.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


Figure  L-15.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


Figure  L-l6.  Algorithm  5,  Velocic  .  -:'or  in  the  X  Direction  Versus  Time 
Target  Profile  5 


Figure  L-17 .  Algorithm  5,  Velocity  in  the  Y  Direction  Versus  Time 
Target  Profile  5 
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igure  L-19.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


Figure  L-20.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  6 


Figure  L-21.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  6 


Figure  L-?3.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
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Figure  L-2U.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  7 
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Figure  L-25.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  7 


Figure  L-28.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  8 
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Figure  M-l.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-2.  Algorithm  6,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  1 


Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  1 


Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-6.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  2 


Figure  M-7 .  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 
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Figure  M-8.  Algorithm  6,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  3 


Figure  M-9.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  3 


igure  M-10 .  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


igure  M-ll.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-12 .  Algorithm  6,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  4 


Figure  M-13.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  4 


Figure  M-14.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-15.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-l6.  Algorithm  6,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  5 


Figure  M-17.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  5 
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Range  Error  Versus  Time,  Target  Profile 


Era 


Figure  M-19.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-20.  Algorithm  6,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  6 


Figure  M-21.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  6 


22.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-23.  Algorithm  6,  Range  Error  Versus  Time,  7.  ...  .  roj  xle 


Figure  M-24.  Algorithm  6,  Velocity  Error  In  the  X  Direction  Versus  Time 
Target  Profile  7 
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Figure  M-25.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  7 


-26.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


Figure  M-27.  Algorithm  6,  Range  Error  Versus  Time,  Target  Profile 


1-28.  Algorithm  6,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  8 
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Figure  M-29.  Algorithm  6,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  8 
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Figure  N-l.  Algorithm  5,  Range  Error  Versus  Time,  Target  Maintaining 
Collision  Course 


Figure  N-2.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Maintaining  Collision  Course 


Figure  N-4 .  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


Figure  N-5.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile  4a 


Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  ^A 
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Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  Aa 


Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
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Figure  N-10.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  4b 


ocity  Error  in  the  Y  Direction  Versus  Time 


Figure  N-12.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile  5A 


Figure  N-14.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  5A 


Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  5A 
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Algorithm  5,  Range  Error  Versus  Time,  Target  Profile  5B 


Figure  N-l8.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus 
Time,  Target  Profile  5B 
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Figure  N-2C.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile  4c 


rithm  5,  Range  Error  Versus  Time,  Target  Profile 
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Figure  N-22.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus 
Time,  Target  -rofile  4C 


Figure  N-23.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus 
Time,  Target  Profile 


igure  N-2A.  Algorithm  5,  Velocity  Error  in  the  Z  Direction  Versus 
Time,  Target  Profile  JJC 


APPENDIX  0 


GRAPHICAL  RESULTS  OP  ALGORITHM  FIVE  AGAINST 
NONMANEUVERING  TARGETS  WITH  VARYING 
MEASUREMENT  ERROR  VARIANCES 

Throughout  this  appendix,  the  standard  deviation  of  the 
angle  measurement  errors  is  referred  to  as  OanGLE*  and  the 
standard  deviation  of  the  angle  rate  measurement  errors  as 

°RATE  *  when  either  °ANGLE  0r  °RATE  ls  n0t  exPlicitly  given 
in  the  plot  caption,  it  is  assumed  to  be  the  nominal  of  100 

yrad  or  20  yrad/sec,  respectively. 
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Figure  0-1.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 

“rate  '  2  “rad/sec 


Figure  0-2.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
°RATE  =  2  1,rad/sec 


Figure  0-3.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  5,  o  =  2  prad/sec 
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Figure  0-5.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
°RATE  =  200  yrad/sec 


Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus 
Time,  Target  Profile  5,  °p;^rpE  =  200  yrad/sec 


igure  0-8.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus 
Time,  Target  Profile  5,  aRATE  =  200  vrad/sec 


Figure  0-9.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 

~  yrad 


Figure  0-11.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus 
Time,  Target  Profile  5,  ° angle  =  10  VJrad 


Figure  0-12.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus 
Time,  Target  Profile  5,  0 ANGLK  =  ^  prad 


Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
° ANGLE  =  1  mrad 
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Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
“STOLE  '  1  *>•»« 


Figure  0-15.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  5,  ° /^CLE  =  1  mrad 


TIME  (SECONDS) 


Figure  0-l8.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
0 RATE  =  2  ^rad/sec 


Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus 
Time,  Target  Profile  7,  o  =  2  prad/sec 


Figure  0-20.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus 
Time,  Target  Profile  7,  =  2  prad/sec 


Figure  0-21.  Algorithm  5,  Range  E^ror  Versus  Time,  Target  Profile 
°n,mr.  =  200  prad/sec 


Figure  0-22.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
Orate  =  200  wrad/sec 
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Figure  0-23.  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  7,  °RATE  =  200  prad/sec 


Figure  0-24.  Algorithm  5,  Velocity  Error  in  the  Y  direction  Versus  Time 
Target  Profile  7,  oD.  =  200  prad/sec 


Figure  0-25.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 


0-26.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 
°ANGLE  =  10  wrad 


-27.  Algorithm  5,  Velocity  Errc-  in  the  X  Direction  Versus 
Time,  Target  Profile  7,  ■  .  =  10  prad 


-29.  Algorithm  5,  Range  Error  Versus  Time,  Target  Profile 

o,,,„ir  =  1  mrad 
ANGLE 
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Figure  0-31-  Algorithm  5,  Velocity  Error  in  the  X  Direction  Versus  Time 
Target  Profile  7.  =  1  mrad 


-32.  Algorithm  5,  Velocity  Error  in  the  Y  Direction  Versus  Time 
Target  Profile  7,  0  ^OLE  =  1  mrad 


APPENDIX  P 


VALUES  FOR  P(t  ) 

This  appendix  contains  a  table  which  presents  all  of 
the  values  used  in  the  diagonal  P(t  )  matrix  for  all  the 
algorithms . 


Table  P-1  Values  for  P(t  ) 

—  o 


1 

ALGORITI 

2 

W  NUMBER 

3 

4 

5 

6 

Pll(to} 

1012 

1012 

1012 

1012 

io12 

1012 

P22^fco^ 

2.25xl06 

106‘ 

!08 

IO6 

2.25xl06 

2.25xl06 

P33(to> 

103 

106 

JO8 

1012 

2.2f>xl06 

?.25xl06 

[Vto) 

4xl02 

2.25xl06 

2.25xl06 

IO6 

IO4 

io4 

P55(to> 

103 

2.25x106 

2.25xl06 

- 

- 

- 

P66(to} 

4xl02 

io1' 

2.25xl06 

- 

- 

- 

P77(to) 

103 

103 

- 

- 

_ 

- 

P88(to) 

- 

103 

- 

- 

- 

- 

VV 

103 

- 

- 

- 

- 

APPENDIX  Q 

DISCUSSION  OP  THE  BAYESIAN  FILTERING  APPROACH 

The  Bayesian  filtering  approach  discussed  in  Reference 
12  was  investigated  briefly.  This  approach  discretizes  the 
probability  density  function  over  a  grid  in  n^space,  where 
the  state  vector  is  of  dimension  n.  The  propagation  cycle 
propagates  each  of  these  state  space  grid  points  according 
to  the. dynamics  equations;  the  update  cycle  changes  the 
probability  associated  with  each  of  the  grid  points  according 
to  a  function  of  the  measurement  residual  (which  must  be 
calculated  for  each  grid  point).  Dynamics  noise  has  the  effect 
of  generating  new  grid  points  in  the  area  of  highest  proba¬ 
bility.  Since  there  is  no  error  covariance  matrix,  there  is 
no  need  to  solve  the  Ricatti  equation  on  line.  This  method 
is  also  supposed  to  alleviate  the  divergence  problem  which, 
according  to  Dr.  Sorenson,  plagues  the  extended  Kalman  filter 
in  some  applications  such  as  bearings-only  ranging. 

The  biggest  problem  found  with  this  method  was  in  main¬ 
taining  the  number  of  grid  points  at  an  acceptably  low  level. 

In  the  bearings-only  tracking  example  shown  in  Reference  12, 
it  is  assumed  that  no  dynamics  driving  noise  is  being  intro¬ 
duced  into  the  system.  It  is  therefore  possible  to  track 
the  target  without  generating  new  grid  points,  thus  making 
the  limiting  of  the  number  of  points  relatively  simple. 

If  however,  new  grid  points  are  generated  by  dynamics 
driving  noise,  several  problems  arise  immediately.  The  first 
of  these  problems  is  the  generation  of  the  new  points;  that 


is,  where  to  place  them  and  how  to  assign  a  probability  to 
them.  After  they  are  generated,  not  only  do  the  points  with 
very  low  probability  have  to  be  discarded,  but  some  method 
must  be  found  for  combining  the  points  that  are  "close  to¬ 
gether"  in  n-space.  If  this  were  not  done,  it  would  be  pos¬ 
sible  for  points  with  high  associated  probability  to  break 
into  enough  new  points  with  smaller  probabilities  that  all  of 
these  new  points  would  be  discarded  as  improbable,  even  though 
the  probability  density  of  the  region  in  question  may  not 
have  changed  appreciably. 

One  method  examined  for  accomplishing  this  was  to  pro¬ 
pagate  the  grid  points,  using  no  dynamics  noise  and  reinitialize 
occassionally  about  either  the  "center  of  mass"  of  the  old 
system  of  grid  points  or  the  point  with  the  highest  associated 
probability.  This  involves  picking  a  single  point  and  estab¬ 
lishing  a  new  grid  in  n-space  with  the  chosen  point  as  the 
center.  The  question  now  becomes  how  to  reassign  the  proba¬ 
bilities  so  that  the  probability  density  information  con¬ 
tained  in  the  old  grid  is  not  completely  disregarded.  It 
was  at  this  point  that  efforts  in  the  Bayesian  method  were 
abandoned;  however,  this  approach  is  worth  pursuing  if  time 
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20.  ABSTRACT  (Continua  on  ravarma  mldm  It  nacammary  and  Idantlty  by  &'.>•-*  numbar) 

Six  algorithms  for  finding  the  range  to  an  airborne  target 
using  noise-corrupted  bearing  and  bearing  rate  measurements 
from  an  airborne  tracker  were  developed  and  evaluated .  The 
algorithms  all  employ  extended  Kalman  filters,  one  using  a 
spherical  coordinate  system  representation,  and  the  other  five 
using  Cartesian  system  representations.  The  target  models 
include  independent,  Gauss-Markov  accelerations  (two  algorithms), 
constant  turn  rate  motion  in  a  single  plane  (one  algorithm),  and 
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basically  straight  and  level  flight  (three  algorithms). 

The  algorithms  were  evaluated  in  a  Monte  Carlo 
analysis.  Tlie  truth  model  for  this  analysis  was  based 
upon  two  trajectories , one  for  the  target  and  one  for 
the  attacker,  which  were  deterministically  set  before 
the  Monte  Carlo  runs.  The  output  of  the  simulation  was 
composed  of  plots  of  the  error  process,  including  the 
mean  of  the  errors,  the  mean  of  the  errors  plus  and 
minus  one  standard  deviation,  and  the  filter-generated 
estimate  of  the  standard  deviation  of  the  errors. 

It  was  found  that,  due  to  an  observability  problem, 
only  the  algorithms  which  modelled  target  motion  as 
straight  and  level  flight  worked  satisfactorily.  These 
algorithms  worked  best  in  scenarios  in  which  the  actual 
target  motion  was  nearly  directly  toward  or  directly 
away  from  the  attacking  aircraft . 
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